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Preface 



The properties of linear systems provide very powerful design and analysis 
tools but the behavior of a nonlinear system may be much more complex. 
By neglecting nonlinear behaviors, resulting control designs can have unpre- 
dictable stability and degraded performance results. In Chapter 1, several 
simple examples are provided to highlight some of the pitfalls experienced 
by linear systems theory because of their inability to encapsulate and com- 
pensate for these effects, including the limitations of linearization, loss of 
tracking performance, and peaking phenomena. 

Given the strong impetus to study nonlinear systems, many texts have 
been written on this subject. Some texts target the theoretical mathemat- 
ical issues with little treatment of physical applications, while other texts 
target specific application areas. The authors of this text were motivated 
by the desire to produce a reference book that provides a balance between 
mathematically rigorous theoretical development and the application of 
various Lyapunov-based techniques to a broad class of practical engineer- 
ing systems. Many applications could be addressed by this methodology 
but this text is not intended (nor could be) a comprehensive exposition of 
all engineering systems. Rather, fundamental development is provided to 
target some classic problems as well as emerging engineering applications. 
As shown by the manner in which the methods are applied and explained, 
the authors intend this reference book to provide insight into control de- 
signs for additional engineering applications. 
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In Chapter 2, control applications for mechanical systems are examined. 
In the first section of the chapter, several adaptive controllers are devel- 
oped and experimentally demonstrated for an autobalancing tracking ap- 
plication, which is motivated by the desire to develop an alternative means 
to mitigate the vibrational effects of rotating systems. Unmanned surface 
vessels are becoming an increasingly important tool in marine applications 
(e.g., offshore oil industry), and so several adaptive automatic ship control 
systems are developed in the second section. Based on the development 
of the full-state feedback adaptive controllers, design techniques are also 
developed that illustrate how an output feedback controller can be con- 
structed to improve reliability and/or reduce the noise, inherent in velocity 
signals. In the third section of Chapter 2, design techniques based on a unit 
quaternion formulation are presented for the tracking control problem for 
a general class of Euler-Lagrange systems. As an example, these techniques 
are applied to an unmanned underwater vehicle application. 

In Chapter 3, controllers are developed for electric machines, described by 
electrical subsystem dynamics, a torque coupling that represents the electri- 
cal to mechanical energy conversion, and mechanical subsystem dynamics. 
In the first section of this chapter, a brief review of standard field-oriented 
control schemes for induction motors is provided. Through systematic al- 
terations of the legacy control methodology, nonlinear techniques are pre- 
sented that illustrate how the injection of nonlinear control elements can 
be used to yield improved stability results and performance characteris- 
tics. An adaptive extension is also provided to address parametric uncer- 
tainty associated with the mechanical load. To address applications that 
require a high-precision machine, the second section of this chapter uses 
a general nonlinear model of a switched reluctance motor (SRM) to de- 
velop an adaptive controller and an associated commutation strategy. This 
strategy is based on the full-order model (i.e., the electrical dynamics are 
not neglected), compensates for uncertainty in electromechanical model, 
uses a flux linkage model that includes magnetic saturation effects, and 
eliminates all control singularities (i.e., the voltage control input remains 
bounded for all operating conditions). The performance of this strategy 
is demonstrated on an SRM testbed. Motivated by the increasing num- 
ber of commercial high-performance applications in the domain of rotating 
machinery, the third section of this chapter targets the development of a 
nonlinear tracking controller with an associated commutation strategy for 
a six-degree-of-freedom active magnetic bearing system. 

In Chapter 4, several different robotic applications are examined. In the 
first section, a repetitive learning control strategy using Lyapunov-based 
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illustrates how additional system information can be exploited in a control 
design. As an example, the repetitive nature of some robotic tasks is ex- 
ploited to develop a controller to mitigate disturbance effects and improve 
link position tracking performance. Since the learning-based controller esti- 
mate is generated from a Lyapunov-based stability analysis, development is 
also presented to illustrate how additional control terms can be integrated 
to compensate for nonperiodic components associated with the unknown 
robot dynamics. Experimental results are provided to illustrate these con- 
cepts. In many indust rial/manufacturing applications, a robot manipula- 
tor is required to make contact with the environment. To address these 
applications, an adaptive tracking controller is developed, which ensures 
asymptotic position/force tracking performance despite parametric uncer- 
tainty for robot manipulators under contact force constraints. An extension 
is provided that also describes how the full-state feedback controller can 
be modified to eliminate the need for velocity measurements. Experimental 
results of the output feedback controller are presented. Advances in control 
and sensor technologies have spawned new robotic applications where the 
robot is required to operate in unstructured environments. Camera systems 
can provide a passive noncontact sense of perception in unstructured en- 
vironments, so the third section of this chapter targets the development of 
fixed camera visual servoing control designs in which visual information is 
embedded directly in the feedback-loop of the control algorithm. An exten- 
sion is provided that incorporates redundant robot manipulators, and an 
adaptive controller is also developed for the camera-in-hand problem for 
applications not well suited to the fixed camera configuration. 

Chapter 5 focuses on various aerospace applications. Based on the desire 
to control the attitude of an object without singularities, a full-state feed- 
back, quaternion-based attitude tracking controller is developed in the first 
section. This controller compensates for the nonlinear dynamics of a rigid 
spacecraft with parametric uncertainty in the inertia matrix. An output 
feedback extension is also provided to eliminate additional sensor payload. 
Typically, spacecraft use separate devices to provide energy storage and at- 
titude control. In the second section of this chapter, an adaptive integrated 
power and attitude control system is developed for a nonlinear spacecraft 
model where the body torque is produced by flywheels operated in a reac- 
tion wheel mode. The adaptive quaternion-based controller forces a space- 
craft to track a desired attitude trajectory while simultaneously provid- 
ing exponential energy/power tracking. Another key technological concept 
in aerospace systems is the distributed functionality of a large spacecraft 
among smaller, less-expensive, cooperative spacecraft. Flying two or more 
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spacecraft in precise formation is typically referred to as multiple satellite 
formation flying (MSFF) and presents a number of complex challenges. In 
the final section of this chapter, the full nonlinear dynamics describing the 
relative positioning of MSFF is used to develop a Lyapunov-based nonlinear 
adaptive control law that guarantees asymptotic convergence of the posi- 
tion tracking error in the presence of unknown, constant, or slow- varying 
spacecraft masses, disturbance forces, and gravity forces. 

The engineering systems described in the previous chapters are fully ac- 
tuated (i.e., the number of control inputs (actuators) equal the number of 
degrees of freedom). However, because of actuator failures or various con- 
struction constraints some applications are underactuated (i.e., the degrees 
of freedom exceed the number of control inputs). In Chapter 6, various 
design strategies are examined that exploit some coupling between the un- 
actuated states and the actuated states to achieve the control objective. 
The first underactuated application examined is an overhead crane sys- 
tem. Motivated by the desire to achieve fast and precise payload position- 
ing while mitigating performance and safety concerns, several controllers 
are developed in the first section of this chapter that exploit the coupling 
between the payload and gantry dynamics. In the second section, a dy- 
namic oscillator-based control strategy is developed for the position and 
attitude tracking and regulation problems for vertical take-off and land- 
ing (VTOL) aircraft modeled by under actuated dynamics that are non- 
linear, nonminimum-phase, and subject to nonholonomic (nonintegrable) 
constraints. As an extension to the design approach used to address the 
VTOL problem, an automotive steering problem and an underactuated 
surface vessel problem are also examined. In the third section of this chap- 
ter, the kinematics of an under actuated satellite are formulated in terms of 
the constrained unit quaternion, and a similar (quaternion-based) dynamic 
oscillator control structure is developed to achieve tracking and regulation. 
As an extension to the design, an integrator backstepping technique is used 
to incorporate the dynamic model of an axisymmetric satellite. 

The material in this text is intended for readers with a background in un- 
dergraduate systems theory and is written to be beneficial for students and 
practicing research and development engineers in the area of controls. The 
material in this book (unless otherwise specified) is based on the authors’ 
control systems research directed at engineering applications. 

To produce this text, significant assistance has been provided by var- 
ious individuals. Specifically, the authors would like to express our most 
sincere appreciation to Marcio de Quieroz of Louisiana State University 
and Erkan Zergeroglu of the Gebze Institute of Technology for their contri- 
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butions and support of this work. We also acknowledge Vikram Kapila of 
Polytechnic University for his contributions and technical insight regarding 
aerospace systems, Oak Ridge National Laboratory research staff members 
John Jansen, Lonnie Love, and Francois Pin, and the support by the fol- 
lowing past and present graduate students of the Department of Electrical 
Engineering at Clemson University, whose efforts helped to realize this 
book: Bret Costic, Youngchun Fang, Matthew Feemster, Jian Chen, Vilas 
Chitrakaran, Michael McIntyre, Pradeep Setlur, and Bin Xian. 
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Introduction 



1.1 Pitfalls of Linear Control 

A common engineering practice is to assume that a system can be described 
by a set of linear differential equations for some operating range of interest 
as follows 

X = Ax + Bu (1-1) 

where x{t) denotes the states of the system, A, B denote time invariant ma- 
trices, and u{t) denotes the control input. Based on the assumption that 
(1.1) accurately describes the system behavior, the control practitioner can 
then exploit various properties from linear control theory. As stated in [10], 
in the absence of the input signal (i.e., the unforced system), these proper- 
ties include (1) a unique equilibrium point if the A matrix is nonsingular, 
(2) the equilibrium point is stable if the eigenvalues of A have negative real 
roots, and (3) the linear differential equations can be solved analytically, 
allowing the transient response to be explicitly determined. When a con- 
trol input u{t) is present, linear time invariant systems exhibit properties 
including (1) superposition, (2) asymptotic stability of the unforced system 
ensures bounded-input bounded-output stability, and (3) a sinusoidal input 
leads to a sinusoidal output of the same frequency. 

While the properties of linear systems provide powerful design and analy- 
sis tools, the behavior of a nonlinear system may be much more complex 
than a linear model can encapsulate. By neglecting nonlinear behaviors, re- 
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suiting control designs can have unpredictable stability and degraded per- 
formance results. In the following sections, several examples are provided 
to highlight some of the pitfalls experienced by linear systems theory due to 
the inability to encapsulate and compensate for these effects. Specifically, 
examples are provided to illustrate the limitations of linearization and the 
potential for counterintuitive destabilizing effects. 

1.1.1 Limitations of Linearization 

As described previously, linear control design and the associated properties 
of linear theory are based on the underlying assumption that the system 
under consideration can be effectively described by a set of linear differ- 
ential equations. Unfortunately, the resulting approximate linear equations 
are typically only valid in a neighborhood of an operating point, and hence, 
only describe the behavior of the actual system in that vicinity. In addition, 
some system phenomena cannot be captured by a set of linear equations. 
For example, some natural nonlinear effects are discontinuous and the re- 
sponse from these effects cannot be approximated by a linear function. 
These discontinuous nonlinear effects (e.g.. Coulomb friction, backlash, hys- 
teresis) are often called “hard nonlinearities.” Although hard nonlinearities 
cannot be linearly approximated, physical systems that exhibit these effects 
are often approximated by neglecting these effects. Additional nonlinear 
phenomena include finite escape time, limit cycles, and chaos (a more com- 
plete description of these and other phenomena are provided in [5, 10]). As 
previously stated, the stability and performance of linear control systems 
may be compromised by neglecting such effects. 

To illustrate the impact of the loss of system information through lin- 
earization, consider the following first-order scalar system [10] 

X = —X -f- x^ (1*2) 

where x{t = 0) = xq. After linearizing (1.2) about the stable equilibrium 
point x{t) = 0, the resulting dynamics and respective solution can be de- 
termined as follows 

x(t) = —x(t) x{t) = XQexp{—t) . (1.3) 

Hence, (1.3) indicates that for any initial condition xq the system will 
exponentially converge to the stable equilibrium point. However, by setting 
the left side of (1.2) to 0, it is clear that two equilibrium points exist (at 
x(t) =0 and x{t) = 1) for the nonlinear system. To illustrate the impact 
of neglecting the second equilibrium point, the solution to the nonlinear 
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system can be determined by integrating (1.2) as follows 

, . (1,4) 

1 - Xo + Xoexp(-t) 

From (1.4), it is clear that if the initial condition is xq < 1, then the system 
will converge to the stable equilibrium point as determined by the linear 
system model. However, if the initial condition is xq > 1, the system will 
rapidly escape towards infinity within a finite time (i.e., finite escape time). 
To illustrate this effect. Figure 1.1 depicts the response of x{t) for various 
initial conditions. From Figure 1.1, the rapid escape towards infinity can 
be observed for initial conditions xq > 1. 




FIGURE 1.1. Nonlinear system response for various initial conditions. 



In addition to the potential for unpredictable (from the linearized equa- 
tions) responses as illustrated by the previous example, linearization may 
alter the structure of the system so that it becomes intractable. For exam- 
ple, consider the following nonlinear system 







COSX3 


0 ■ 


X2 




sin X3 


0 


. ^3 _ 




0 


1 _ 



(1.5) 



The system introduced in (1.5) is a classic set of equations that are used to 
describe the motion of systems such as a unicycle or wheeled mobile robots 




4 



1. Introduction 



(see [1] for examples of other physical systems). Clearly, these physical 
systems are controllable (see [2] for a mathematical examination of the 
controllability); however, if the system dynamics are linearized about the 
point x^{t) = 0 as follows 



is 



■ 1 O' 






0 0 




Ui 


. 0 1 . 




. ^2 . 



( 1 . 6 ) 



then the linearized dynamics for X 2 (t) become uncontrollable. 

Another limitation is the loss of tracking performance caused by the 
requirement for the controller to be formulated based on a linear model of 
the system. To illustrate the potential for degraded performance, consider 
the following second-order scalar system 

m(l + q^)q -\-bqq = u (1.7) 



where it is assumed that q(t) and q{t) are measurable states, and m = 1.5 
and 6 = 2 are known positive constants. The objective of a tracking control 
problem is to eliminate the mismatch between q{t) and a desired time- 
varying trajectory, denoted by qd{t). To quantify the mismatch, a tracking 
error denoted by e{t) is defined as follows 



e = qd-q • 



( 1 . 8 ) 



By neglecting the nonlinear terms, the system in (1.7) can be reduced to 
the following simple linear system 



mq = u . (1-9) 

Based on (1.9), a typical linear controller could be designed as follows 

u = mqd + kyC + k^e 

' ' ( 1 . 10 ) 

feedforward feedback 

to yield the following stable closed-loop dynamics for the linear system 

me kye kpe = Q (1-H) 

where qd{^) denotes the second time derivative of the desired trajectory, 
and ky and kp are positive constant control gains. By selecting ky = kp = 
1000, the tracking performance of (1.10) for the linear model in (1.9) with 
Qd{i) = 5 H- 2sin(t) is illustrated in Figure 1.2 with the associated control 
effort in Figure 1.3. 




Feedback Control Effort 




Feedforward Control Effort 




FIGURE 1.3. Feedback and feedforward control effort. 
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As illustrated in Figure 1.2, the linear controller can be applied to the 
linear model in (1.9) to yield perfect tracking response. However, when the 
same controller is applied to the actual nonlinear system given in (1.7), 
the tracking performance degrades as illustrated in Figure 1.4 with the 
associated control effort in Figure 1.5. The degraded tracking performance 
illustrated in Figure 1.4 is due to the fact that the nonlinear effects have 
been neglected and act as disturbances on the system. While the control 
gains introduced in (1.10) could have been adjusted to achieve different 
performance, perfect tracking of the reference input cannot be achieved 
(notice the steady state oscillations about zero depicted in Figure 1.4) 
because of the absence of a nonlinear feedforward term that can exactly 
compensate for the nonlinear components of the system. As a means to 
develop controllers that do not simply neglect the nonlinear terms, modern 
linear control practitioners employ various robust linear control approaches. 
The goal of these approaches is not to neglect the nonlinear terms; rather, 
the goal is to bound the effects of the nonlinear components. Unfortunately, 
these approaches are based on worst-case scenarios that require high-gain or 
high-frequency feedback, and the resulting performance is still degraded by 
the requirement to ultimately reduce the system model to a linear system 
to enable the use of linear control design tools. The subsequent sections of 
this chapter illustrate how controllers can be developed for this example 
problem from a nonlinear Lyapunov-based methodology to achieve perfect 
tracking. 

1.1.2 Dangers of Destabilization 

In some cases the use of linear controllers may result in counterintuitive 
destabilizing effects. For example, a peaking phenomenon occurs in linear 
systems that can have a destabilizing effect (potentially resulting in finite 
escape time) on the nonlinear subsystem dynamics. To illustrate this con- 
cept, consider the coupled partially linear system depicted in Figure 1.6 
that is described by the following dynamics [11, 12] 

i = ( 1 . 12 ) 

y — Ay ^ Bu (1-13) 

where x{t) G y{t) G and u(t) G R^. The following assumptions are 
made for the system introduced in (1.12) and (1.13). 

Assumption 1.1: The pair (A,B) is assumed to be controllable. 

Assumption 1.2: The nonlinear function /(•) is assumed to be first-order 
differentiable with respect to time. 
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0 

FIGURE 1.4. 
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u(t) 


f A 

Linear 


y(t) 


f ^ 

Nonlinear 


Subsystem 


Subsystem 




L J 




L J 



x(t) 

K.1^ 



FIGURE 1.6. Partially linear system. 



Assumption 1.3: The zero dynamics (i.e., x = f{x,0)) have 0 as a glob- 
ally asymptotically stable equilibrium. 



Based on (1.12) and (1.13) and Assumptions 1.1-1. 3, it seems intuitive 
that a linear controller can be designed to exponentially drive the dynamics 
for y{t) to zero, resulting in global asymptotically stable zero dynamics for 
the nonlinear subsystem. However, this strategy can lead to destabilization 
and even finite escape time of the nonlinear dynamics. To illustrate this 
point, consider the following simple example [12] 



2 



(1.14) 



yi=y2 ij2=u 



(1.15) 



From (1.14), it is clear that Assumption 1.3 is valid. By designing a linear 
control input as follows 



u = -a?yi - 2 ay 2 , (1-16) 

repeated eigenvalues of the closed-loop linear subsystem will result at —a. 
Linear analysis methods can be used to determine the exact solution for 
7/2 (t) as follows 

y2 = . ( 1 - 1 '^) 

Prom the solution given in (1.17), it is clear that the dynamics for \y 2 if)\ 
rise to a peak and then exponentially decay to zero. By setting the time 
derivative of y 2 {t) to zero, it can be determined that the peak occurs at 
t = Given (1.17), it is clear that larger values of a will drive 2 / 2 (0 
zero faster. Hence, from Assumption 1.3 it seems that larger values of a 
will allow the nonlinear system to be stabilized faster. However, as stated 
in [6] this is simply a “high-gain mirage.” To clarify this mirage, we can 
substitute (1.17) into (1.14) and then integrate the resulting expression as 
follows 

^ 

1 + Xq (t -f- (1 -h at) exp(— at) — 1) 






(1.18) 
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where x(t = 0) == xq- The destabilizing effects of the peaking phenomena 
can now be understood by substituting values for xq, u, and t into (1.18). 
For example, for a = 10 and Xq = 2.176, the response for x^(t = 0.5) 
becomes unbounded (i.e., finite escape time). Interestingly, by approximat- 
ing by (1 — at) it is easy to verify that increasing the feedback gain 
a causes the system to escape at a faster rate! Additional examples and a 
discussion of these phenomena are provided in [6, 11, 12]. In Section 13.2 of 
[5] , nonlinear (Lyapunov-based) control examples are provided to illustrate 
how the integrator backstopping technique can be used to achieve global 
stabilization of triangular systems such as (1.12) and (1.13). 

1.2 Lyapunov-Based Control 

In the previous section, various pitfalls of linear control theory were illus- 
trated through several examples. These examples highlight the intuitive 
idea that control strategies that neglect some system effects have the po- 
tential for unexpected stability results and performance degradation. While 
linear control strategies may provide acceptable results when the effects of 
the neglected phenomena are not dominant (either naturally or due to im- 
posed constraints on the operating range of the system) , it seems apparent 
that control strategies that incorporate known system effects can provide 
significant advantages for a broader class of systems. Based on this concept, 
researchers have been motivated to investigate various methodologies for 
nonlinear control design and analysis. Although this investigation has led 
to several important methodologies (e.g., singular perturbation, describing 
functions, phase plane analysis), Lyapunov-based design^ and analysis ap- 
proaches have emerged as some of the most flexible, intuitive, and powerful 
tools. 



1.2.1 Exact Model Knowledge Example 



If the nonlinear effects can be exactly modeled (which is rarely possible 
from a practical standpoint), a potential approach is to exactly cancel the 
nonlinear dynamic effects with a model-based feedforward compensation 
term as follows 



^ = //(g,_4) + fb(^^ 

feedforward feedback 



(1.19) 



^Lyapunov theory and its derivatives are named after the Russian mathematician 
and engineer Aleksandr Mikhailovich Lyapunov (1857-1918). 
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where ff(q, q) denotes the nonlinear feedforward term, and fh{q, q) denotes 
feedback terms. The structure of the feedforward and feedback components 
is motivated by the physics of the nonlinear system, the resulting closed- 
loop systems, and by the subsequent analysis. Lyapunov methods are based 
on a very simple result from calculus that if a differentiable function is posi- 
tive for all time, and its time derivative is negative or zero, then the function 
will decrease towards zero or some positive constant. This result provides 
the basis for the iterative design philosophy that is used to construct (1.19) 
to shape the resulting closed-loop error systems. For example, a possible 
control design for the system given in (1.7) could be developed as follows 



u hqq ^ m{l q^)qd + (1 + ^^) (A:r -f ae) 

V / V ^ / 

feedforward feedback 



( 1 . 20 ) 



In (1.20), a, k denote positive control gains, and r{t) is defined as follows 



r = e -h ae 



( 1 . 21 ) 



Insight into the motivation for the design in (1.20) can be obtained through 
the following theorem and Lyapunov-based analysis. 



Theorem 1.1 The controller introduced in (1.20) provides global exponen- 
tial tracking in the sense that 

e{t) = e (0) exp {—at) + ^ ^ Texp f (~<^0 

a ^ 

m 

( 1 . 22 ) 




Proof: To prove the result in Theorem 1.1, consider the nonnegative 
function V{t) G R defined as follows 



V 




(1.23) 



After taking the time derivative of (1.23) the following expression can be 
obtained 



V ^r [qd- 



u — bqq 



+ ae 



(1.24) 



where (1.7), (1.8), and the time derivative of (1.21) were used. After sub- 
stituting (1.20) into (1.24), the following expression is obtained 



V = -—kV 
m 



(1.25) 
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where (1.23) was utilized. By integrating (1.25), the following result can be 
obtained 

r {t) =r (0) exp (1.26) 

where (1.23) was utilized. Based on the definition of r{t) introduced in 
(1.21) and the result in (1.26), linear methods can be used to prove the 
result in (1.22) (see also Lemma A. 14 of Appendix A). □ 

Remark 1.1 For the particular case when a = a repeated root is ob- 
tained, and the expression in (1.22) becomes 

e(t) = [e(0) + (e(0) + ae(0)) t] exp{—at) for a — ~ . (1-27) 

To verify this result, the expression in (1.26) can be substituted into (1.21) 
and then integrated. 



Remark 1.2 Linear analysis arguments could have also been utilized to 
examine the stability of the tracking error. For example, by substituting 
(1.20) into (1.7), the following expression can be obtained 



(k + a). ka 

e + ^e-h — e = 0 . 

m m 



(1.28) 



The expression in (1.28) can be integrated to yield the same expression as 
in (1.22). 



1.2.2 Simulation Results 

After numerically simulating the controller designed in (1.20) with a = 
A: = 1 for the system in (1.7) with the same desired trajectory as in the 
previous linear control example, the position tracking error and control 
effort depicted in Figure 1.7 and Figure 1.8, respectively, are obtained. 
From a comparison of the results illustrated in Figure 1.4 and Figure 1.5 
with the results illustrated in Figure 1.7 and Figure 1.8, it is clear that the 
steady state error present in Figure 1.4 can be eliminated (theoretically) 
at the expense of increased control effort due to the nonlinear feedforward 
component. 

Clearly, the performance of the approach in (1.19) is inherently tied to the 
ability of the model to accurately represent the physical system. However, 
developing a set of coupled differential equations that accurately represents 
the dynamic model is a challenging task. The challenge arises because the 
parameters of the model may not be known (or known precisely) and they 
may change over time (these model uncertainties are often referred to as 
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parametric uncertainty or structured uncertainty [3]). In addition to para- 
metric uncertainty, the effects of some phenomena may be very difficult or 
impossible to accurately model, and hence, the effects may be neglected 
from the model (these disturbances are often referred to as unstructured 
uncertainty [3]). To illustrate the effect of model uncertainty, a numeri- 
cal simulation was performed for the controller given in (1.20), where the 
constant parameters m and b of (1.7) are increased by 20% (however, the 
controller is based on the original values). Using the same control gains, the 
resulting tracking error and control effort are depicted in Figure 1.9 and 
Figure 1.10, respectively. From Figure 1.9, it is clear that the parameter 
mismatch results in degraded tracking performance. 



1.2.3 Adaptive Example 

To account for parameter mismatch, adaptive control designs can be con- 
structed as follows 



feedforward feedback 



(1.29) 



where //(g, q) denotes a partial knowledge feedforward term. Based on this 
approach, the controller introduced in (1.20) can be redesigned as follows 

u = bqq-\-m{l-\-q^)qd + {1 + q'^) {kr + ae) 

(1.30) 



feedforward 



feedback 



where the parameter estimates b{t)^ m(t) G M are generated by the following 
differential equations 



b (t) = (t) = r2%r (1.31) 

where Fi, F 2 € M denote positive adaptive update gains. The stability 
of the tracking controller in (1.30) and (1.31) can be proven through a 
Lyapunov- based analysis as in the following theorem. 



Theorem 1.2 The controller introduced in (1.20) provides global asymp- 
totic tracking in the sense that 



lim e{t) = 0 . 



t—^oo 



(1.32) 



Proof: To prove the result in Theorem 1.2, consider the nonnegative 
function V{t) G M defined as follows 



V = -mr' 






- \2 
m) 



(1.33) 
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After taking the time derivative of (1.23) the following expression can be 
obtained 

V = —kr^-hr^(m — m)qd-i-^b — b"jqq"j (1-34) 

-L (b-b^b -L (to - m) m 

where (1.7), (1.8), the time derivative of (1.21), and (1.30) were used. After 
substituting (1.31) into (1.33), the following simplified expression can be 
obtained 

y = -kr‘^ . (1.35) 

Based on the expressions in (1.33) and (1.35), basic results from calculus 
can be used to conclude that the signals in V(t) remain bounded (i.e., r(^), 
b{t), m{t)). From (1.7), (1.8), (1.21), (1.30), and (1.31), analysis can be per- 
formed to prove that r(t), g(t), u(t), 5 (t), m (t) are bounded for all time, 
and hence, r{t) is uniformly continuous. Since r{t) is uniformly continu- 
ous, V{t) is also uniformly continuous; therefore, since V{t) is bounded, 
V(t) — ^ 0 as i oo. From (1.35), it is clear that V(t) -^0 only when 
r{t) 0; hence, from (1.21) it can be determined that F(^) 0 only when 

e(^), e[t) — > 0 (see Lemma A. 15 of Appendix A). Therefore, both global 
stability and convergence of the tracking error as indicated in (1.32) can 
be concluded. □ 

Remark 1.3 While r(t), e{t), e{t) — > 0 as t oo, the adaptive algorithm 
in (1.30) and (1.31) does not ensure that the parameter estimates converge 
to the actual values. A constraint that the desired trajectory be persistently 
exciting (i.e., sujflciently rich) may potentially he placed on the system to 
ensure that (m — m(t)), ^b — b(t)^ 0; hence, as stated in [9], an adaptive 

controller may be modified so as to guarantee exponential tracking. 

Remark 1.4 The simplified analysis in Theorem 1.2 is provided to demon- 
strate the advantages of Lyapunov-based control designs in the presence 
of parametric uncertainty. In the subsequent chapters, various Lyapunov- 
based analysis tools will be more formally constructed. For an overview of 
nonlinear approaches that can he applied to compensate for unstructured 
uncertainty, see [8]. 

1.2.4 Simulation Results 

A numerical simulation was performed for the adaptive tracking controller 
designed in (1.20) for the system in (1.7) with the same desired trajectory 
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as in the previous linear control example where 

a = 0.5, k = 10, Ti = 2.0, Ts - 3.0 . (1.36) 



The resulting position tracking error and control effort are depicted in Fig- 
ure 1.11 and Figure 1.12, respectively. The parameter estimates h{t) and 
rh{t) are depicted in Figure 1.13. From a comparison of the results illus- 
trated in Figure 1.9 and Figure 1.10 with the results illustrated in Figure 
1.11 and Figure 1.12, it is clear that the steady state error present in Figure 
1.9 can be eliminated because the adaptive parameter estimates compen- 
sate for the mismatch between the actual parameters and the estimated 
parameters. In comparison with the results in Figure 1.7, it is clear that 
the adaptive controller exhibits a longer transient. This observation can be 
attributed to the fact that the performance is linked to the speed at which 
the parameter estimates seem to converge to values that best accommo- 
date for the parameter mismatch. Also note that the stability result for the 
adaptive controller becomes asymptotic as compared with the exponential 
results obtained in (1.22). 




FIGURE 1.11. Position tracking error for an adaptive nonlinear controller. 
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1.3 Summary 

In this chapter, motivation is provided for the use of a nonlinear Lyapunov- 
based approach to control design. To this end, several potential pitfalls 
associated with linear systems theory were demonstrated through various 
examples. Several Lyapunov-based designs were then presented to illustrate 
how improved performance can be achieved by using a feedforward control 
term to compensate for the nonlinear effects. From the analysis provided 
for Theorem 1.1 and Theorem 1.2, it can be determined that the control de- 
sign and analysis are formulated through an iterative process. This process 
is facilitated by creative foresight into the interplay between the control 
input (including possible adaptive update signals) and the resulting er- 
ror system embedded in the analysis. In subsequent chapters, a variety of 
Lyapunov-based design and analysis tools are developed and applied to 
different engineering systems. 
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2 

Mechanical Systems 



2.1 Introduction 

In this chapter, several different control applications for mechanical systems 
are examined. The first system discussed is an autobalancing application. 
A perfectly balanced rotating object (i.e., the center of geometry and center 
of mass are coincident) will usually not undergo any vibration. However, 
due to the errors associated with geometric dimensions and the nonhomo- 
geneity of the raw material, the construction of a perfectly balanced object 
is difficult to achieve using a standard manufacturing process. Due to the 
difficulty and/or expense required to construct a perfectly balanced ob- 
ject, some amount of vibration can be expected as an object rotates. This 
vibration can lead to performance degradation and/or failure of the me- 
chanical system. These undesirable vibrational effects are often amplified 
during high-speed rotation. A simple solution to the imbalance problem 
is to introduce passive damping via selective placement of ball bearings. 
However, the use of a passive bearing often leads to an increase in friction, 
resulting in further degradation of the system performance. An alternative 
means to mitigate the vibrational effects of rotating systems is to produce 
frictionless forces (e.g., magnetic forces) that act on the rotating body. 
These forces can provide an autobalancing capability for the case of high- 
speed rotation-based systems (e.g., precision grinding, turbines, aircraft 
propellers, flywheels). However, since the slightest imbalance can induce 
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very large and potentially destabilizing vibrations, an active control system 
that can generate the desired forces very precisely is needed. Moreover, an 
active control strategy that would not only be capable of stabilizing these 
vibrations, but also be able to identify the imbalance-related parameters 
of the system, would be extremely beneficial. By developing such a con- 
troller, the user would have the information necessary to make decisions 
based upon the imbalance parameters (i.e., shut the system down if it sur- 
passes a predetermined maximum safety threshold). In the first section of 
this chapter, two adaptive control strategies are developed that address 
the autobalancing control objective of regulating the center of geometry 
of a high-speed rotating object that is tracking a desired angular velocity 
profile. Specifically, the first controller uses a gradient adaptive update law 
to compensate for the parametric uncertainty in the system, whereas the 
second controller uses a composite prediction error driven adaptive update 
law to identify and compensate for the uncertain imbalance parameters, 
provided a mild persistency of excitation and additional control gain con- 
ditions are satisfied. The performance of the second autobalance controller 
is demonstrated through experimental results. 

Since unmanned surface vessels are becoming an increasingly important 
tool in marine applications (e.g., offshore oil industry), the development of 
automatic ship control systems has been a topic of considerable interest over 
the past decade. In the second section of this chapter, two adaptive con- 
trollers are developed for dynamically positioned ships (i.e., a ship system 
where the surge, sway, and yaw are controlled via thrusters and propellers 
of the ship [29]). The first controller utilizes full-state feedback (i.e., ship 
position and velocity measurements are available) to achieve global asymp- 
totic tracking despite parametric uncertainty associated with the nonlinear 
ship dynamics. Motivated by the desire to eliminate the requirement for 
ship velocity measurements (e.g., due to the desire to improve reliability 
and/or reduce the noise that is inherent in velocity signals from the control 
system), an output feedback controller (i.e., the controller only requires 
the measurement of the ship position) is also developed. The adaptive out- 
put feedback controller is developed in tandem with a filter-based velocity 
estimator to achieve global asymptotic tracking. The performance of the 
output feedback controller is demonstrated through a simulation study. 

In many mechanical applications the desired trajectory of the system is 
defined in terms of a constant inertial frame. For these applications, mo- 
tivation exists to perform the control design with respect to the inertial 
frame (in the so-called ta^k space of the system). However, precise tracking 
control of the orientation of a mechanical system with respect to an inertial 
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frame (e.g., the orientation of a robot manipulator end-effector with respect 
to the base) is not straightforward. For example, several parameterizations 
exist to describe the orientation angles, including three-parameter represen- 
tations (e.g., Euler angles, Rodrigues parameters) and the four-parameter 
representation given by the unit quaternion. Whereas the three-parameter 
representations always exhibit singular orientations (i.e., the orientation 
Jacobian matrix in the kinematic equation is singular for some orienta- 
tions), the unit quaternion can be used to represent the orientation of a 
mechanical system without singularities. Thus, despite significantly com- 
plicating the control design, the unit quaternion may proffer some specific 
advantages when formulating orientation tracking control problems. 

Given the motivation for a unit quaternion formulation, a unit quaternion- 
based control approach is applied to solve the tracking control problem for 
a general class of Euler-Lagrange systems. Specifically, a full-state feedback 
unit quaternion-based controller is formulated with respect to the inertial 
frame (as typically done for robotic systems). As an example application, 
the dynamics for an unmanned underwater vehicle (UUV) are cast into a 
similar form as the general control problem. However, for this application a 
controller is developed with respect to a body-fixed reference frame (as typ- 
ically done for aerospace and marine applications). Simulation results are 
provided for the unit quaternion-based control development for the UUV. 



2.2 Autobalancing Systems 

In this section, two controllers are developed for the autobalancing problem 
of a rotating unbalanced disk (see Figure 2.1). Specifically, the design of a 
gradient-based adaptive control law is first presented that achieves global 
asymptotic tracking of a desired angular velocity profile while regulating 
the center of geometry of the unbalanced disk. A second controller is then 
developed that utilizes a desired compensation adaptation law (DCAL) [36] 
and a gain adjusted forgetting factor (GAFF) [38] to automatically identify 
the unknown imbalance-related parameters provided a mild persistency of 
excitation (PE) condition is satisfied. Provided this PE condition is satis- 
fied, the second control strategy achieves exponential stability; whereas, if 
the PE condition is not satisfied, global asymptotic tracking/regulation is 
still achieved. 
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FIGURE 2.1. Diagram of the rotating unbalanced mass. 



2.2.1 System Model 



The mechanical system considered in this section consists of a rotating 
unbalanced^ disk that vibrates in a plane perpendicular to its axis of rota- 
tion (see Figure 2.1). A control torque is applied to rotate the disk while 
a pair of perpendicular control forces are applied to regulate planar vibra- 
tion. As typically done for various mechanical systems, Lagrange’s method 
can be used to develop the dynamic equations. Specifically, the rotating 
unbalanced disk is a Lagrangian system that can be characterized by the 
following second-order differential equation 



d f dC\ dC 
dt \dq ) dq 



( 2 . 1 ) 



where C{t) denotes the Lagrangian defined as the difference between the ki- 
netic energy, denoted by T (t), and the potential energy, denoted by PE{t), 
as follows 

C = T-PE. (2.2) 

The position vector q (t) 6 given in (2.1) is defined as follows 

g=[x y 6]^ (2.3) 



where x{t)^ y {t) G R denote the linear position of the disk center of geom- 
etry along the x and y axes, respectively, and ^ (t) G R denotes the angular 



^The disk is unbalanced in the sense that the center of geometry does not coincide 
with the center of mass. 
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position of the disk. The position of the disk center of mass, denoted by 
Xcm (t), Vcm (0 ^ is given by the following expressions 

Xcm = X -f Lcos (6> 4- /3) ycm = 2/ -h Lsin (0 + /?) (2.4) 

where /? € R represents the initial angle subtended by L with the positive 
X axis. The force/torque control input u{t) G R^ given in (2.1) is defined 
as follows 

u=[ Fy (2.5) 

where F^ (t), Fy (t) G R denote the perpendicular and planar control force 
inputs, and (t) G R denotes the torque applied to the disk. The kinetic 
energy for the rotating unbalanced disk can be computed as follows 

i^cm + ylm) + \lcg0^ ( 2 . 6 ) 

where m G R denotes the mass of the disk, Xcm{t)^ ycm{i) ^ R denote 
the velocities of the center of mass of the disk along the x and y axes, 
respectively, 9 (t) e R denotes the disk angular velocity, and leg G R is 
the moment of inertia about the center of geometry given by the following 
expression 

leg ~ Icm "b TflL (^*^) 

where I cm € R is the moment of inertia about the center of mass, and 
L G R denotes the distance between the center of geometry and the center 
of mass. After substituting (2.7) and the time derivative of (2.4) into (2.6) 
and then using some basic trigonometric properties, the kinetic energy can 
be expressed as follows 

T = - 2L sin (0 + /3) xb Fy^ F 2L cos (0 + P)y9 

+ ^ {Icm + mL^) 0^. 

( 2 . 8 ) 

Since no work is performed on the system by conservative forces, the po- 
tential energy of the system is given by the following expression 

PE = 0. (2.9) 

After substituting the kinetic and potential energy expressions given in 
(2.8) and (2.9) into (2.2), the dynamic model of the rotating unbalanced 
disk can be determined from (2.1) as follows 



Mq -f Vmq = u 



( 2 . 10 ) 




26 



2. Mechanical Systems 



where q{t), q{t) 6 denote the disk velocity and acceleration vectors, 
respectively, and the inertia and Coriolis matrices, denoted by M {q) E 
1^3x3 {q^q) E respectively, are defined as follows 



M{q)^ 



—ruL sin {9 + P) mL cos {9 -f P) 



—mL sin {9 + P) 
mL cos {9 + P) 
^cm *2mL 



( 2 . 11 ) 



0 0 —mL cos {9 P) 9 

ym{qA)— 0 0 — mL sin {9 P) b 

0 0 0 



( 2 . 12 ) 



The dynamic system given in (2.10) exhibits the following properties that 
are utilized in the subsequent control development and stability analysis. 



Property 2.1: Symmetric and Positive-Definite Inertia Matrix 

The symmetric and positive-definite inertia matrix M (q) satisfies the 
following inequalities 

mi II4II" < < m2 ll^ll" e (2.13) 

where mi, m 2 G R are known positive constants, and H-H denotes the 
standard Euclidean norm. 



Property 2.2: Skew-Symmetry 

The inertia and Coriolis matrices given in (2.11) and (2.12) satisfy the 
following skew-symmetric relationship 

(1m - ^ = 0 G (2.14) 

where M{q) denotes the time derivative of the inertia matrix. 

Property 2.3: Linearity in the Parameters 



The left-hand side of (2.10) can be linearly parameterized as follows 

Mq-\-Vmq = Y(l> (2.15) 
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where the known regression matrix Y (q,q,q) ^ and the unknown 

constant parameter vector (/> € are defined as follows 



F(-) = 



■ sin {0) 0 - cos {9) 9^ - cos {9) 9 -f sin {9) 9^ 



y cos {9) 9 — sin (9) 9 



0 

0 = [ m 



- sin {9) X 4- cos {9) y 



■ sin (9) 9 — cos (9) 9 

■ cos {9) X — sin {9) y 



mL cos (3 rtiL sin j3 I cm + 2mLp‘ 



0 
0 
9 

(2.16) 

(2.17) 



2.2.2 Control Objective 

The objective of this section is to regulate the center of geometry to the 
position {x = 0, y — 0) while ensuring that the angular velocity of the disk 
tracks a desired trajectory despite the parametric uncertainty associated 
with (2.17). The control objective is made under the assumption that q(t) 
and q{t) are measurable. To quantify the velocity tracking control objective, 
we define the tracking error e (t) G M as follows 



e = 9d-9 (2.18) 

where 9d (t) G M denotes the desired angular velocity of the disk where 
it is assumed that the desired trajectory is selected so that 9d{t)^ Odif)^ 
9 d {t) ^ ^oo- To facilitate the representation of the second-order dynamic 
model of (2.10) as a first-order differential equation, a filtered error signal 
r(t) = [ ^2(0 ^s(^) ^ is defined as follows 



r = 



—X — aix 

-y - OL2V 



e 



(2.19) 



where ai,a 2 G R are positive control gains. As typically done for veloc- 
ity tracking control applications, (2.19) has been constructed so that the 
signals 9d (t) and 9 (t) are not used in the feedback portion of the control, 
since they may become unbounded. 

Remark 2.1 The control objective given in this section is centered on the 
autobalance problem of regulating the center of geometry while ensuring 
angular velocity tracking. In the following development, it is assumed that 
a magnetic bearing system can produce the perpendicular and planar con- 
trol force inputs given in (2.5). That is, only the mechanical dynamics of 
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the magnetic hearing /rotating disk assembly are investigated. In Chapter 
3, a controller is developed for a magnetic bearing system where both the 
mechanical and electrical dynamics are incorporated in the design. 

2.2.3 Adaptive Control 

Control Formulation 

To develop the open-loop error system for r(^), we take the time derivative 
of (2.19), premultiply the resulting expression by M (g), and then substitute 
(2.10) for M{q)q{t) to obtain the following expression 



Mr — —VmT + M 



—aix 




—a\x 


-OL2y 


+ Vm 


-OL2y 


_ Od . 




. Od . 



— u 



( 2 . 20 ) 



where Vm {q, q) ^{t) has been added and subtracted to (2.20). After utilizing 
(2.15), the expression given in (2.20) can be rewritten as follows 



Mr = -Vmr + Yi(t)i-u (2.21) 

where Yi(q,q^t) e denotes a measurable regression matrix, and (j)^ G 
W denotes a constant unknown parameter vector such that 





—a\x 




— QlX 


II 


-Oi2V 


+ Kn 


-OL2V 




. Od . 




. Od _ 



( 2 . 22 ) 



Based on the structure of the open-loop error dynamics given in (2.21) and 
the subsequent stability analysis, we design the control input u{t) as follows 

u^Yi^i+ K^r - [ kpix kp2V 0 (2.23) 

where Y\ (•) is given in (2.21), ^i{q,q,r,t) G W denotes a parameter esti- 
mate vector for </)i, and /cpi, kp 2 G M are positive control constants. Based 
on the subsequent stability analysis, the parameter estimate vector 0i(-) is 
generated according to the following gradient update law 



(2.24) 

The positive-definite control gain matrices Fi € and Kg € given 
in (2.23) and (2.24) are defined as follows 



Fi =diag{rn,Fi2,ri3} 



Ks = dia.g{ksi,ks2,ks3} 



(2.25) 
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where the notation diag{-} indicates a diagonal matrix with the diagonal 
elements given in {•}. After substituting (2.23) into (2.21), the following 
closed-loop error system is obtained 



Mr = - Vmr + - KsT + [ kp\x kp2y 0 (2.26) 

where the parameter estimation error {t) E MP is defined as follows 

4>i=4>i-4>v (2.27) 



Stability Analysis 

The stability of the adaptive tracking controller given in (2.23) and (2.24) 
can now be examined through the following theorem. 

Theorem 2.1 The controller given by (2.23) along with the adaptive up- 
date law given by (2.24) ensure global asymptotic regulation of the position 
of the geometric center and global asymptotic angular velocity tracking in 
the sense that 

lim x{t),y{t),e{t) = 0 (2.28) 

t—*oo 

where e{t) was defined in (2.18) and x(t), y (t) were defined in (2.3). 

Proof: To prove Theorem 2.1, we define a nonnegative function V{t) 
as follows 



V = ^r'^Mr + + ^kp2y^ + (2.29) 

After taking the time derivative of (2.29), substituting (2.26) into the re- 
sulting expression for M{q)r(t), substituting the time derivative of (2.27) 

for (^), and then cancelling common terms, the following expression is 
obtained 

V = -r'^KsV - aikpix^^ - a2kp2y^ (2.30) 

where (2.14) and (2.19) have been used. The development given in (2.29) 
and (2.30) can be used to prove that r{t), x{t), y{t)^ ^ ^oo and that 

r(/:), x(t), y{t) E £2 (see Lemma A. 11 of Appendix A). Since r{t) E £ 00 ? 
Lemma A. 13 of Appendix A can be used along with (2.18) and (2.19) to 
prove that q(t) E £ 00 ; furthermore, (2.27) can be used to determine that 
(^) ^ ^cx 5 * Since the regression matrix Yi (•) is made up of bounded argu- 
ments (where q{t) is only present as an argument of bounded trigonometric 
expressions), Li (•) E Coo] therefore, (2.23) can be used to prove that the 
control input u{t) E £ 00 • It follows from (2.26) that r (t) E Coo] hence. 
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q{t) € £oo- Based on the facts that r(^), r {t) G £oo and r{t) G £ 2 , Bar- 
balat’s Lemma (see Lemma A. 16 of Appendix A) can be invoked to prove 
that 

lim r{t) = 0. (2.31) 

t—KX) 

The condition (2.31) and Lemma A.15 of Appendix A can now be utilized 
to prove the result given in (2.28). Alternatively, the expression in (2.31), 
the results x{t), y(t), q(t) G Coo and x{t), y(t) G £ 2 , and Barbalat’s Lemma 
can be used to prove the result in (2.28). □ 



2.2.4 DCAL-Based Adaptive Control 

In the previous section, a gradient-based adaptive controller was used to 
prove global asymptotic tracking of the angular disk velocity and global 
regulation of the center of geometry despite parametric uncertainty. As 
stated previously, a solution that could automatically identify the unknown 
imbalance-related parameters of the system would be beneficial. Therefore, 
building off of the previous result, a composite^ adaptive, prediction er- 
ror driven, DCAL-based controller is developed that forces the imbalance- 
related parameter estimate vector to converge to the actual values and 
also yields an exponential envelope for the tracking, regulation, and the 
parameter estimate error signals, provided a mild PE condition is satisfied. 

Filtered Torque 

To facilitate the construction of a composite adaptive controller that uses 
a prediction error-based update law, a filtered control input signal can be 
formulated as follows [26, 38] 



Uf = f (2.32) 

where Uf {t) G M denotes a measurable filtered control signal, * denotes the 
standard convolution operation, u{t) was defined in (2.10), and the filter 
function / (t) G M is defined as follows 

/=7exp(-7i) (2.33) 

where 7 G R is a positive filter control gain constant. After substituting 
(2.10) into (2.32) for u (t), standard convolution properties (see Lemma B.l 



^The term composite [38] was coined because the adaptive update law is a combina- 
tion of the gradient and least-squares update laws. 
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of Appendix B) can be used in conjunction with (2.15) to rewrite (2.32) in 
terms of the following linear parameterization 

Uf =Yf {q,q)(p. (2.34) 

In the linear parameterization given in (2.34), 0 denotes the same unknown 
parameter vector defined in (2.17), and Yf denotes a known 

filtered regression matrix that is independent of acceleration measurements 
such that 

Yf<P = (q) q(t) + f (0) M (q) q{t) - f (i) M (q (0)) q (0) 

+/ (t) * {-M (q) q (t) + Vm {q, q) q (O) 

(2.35) 

where f (t) G R can be determined as follows 

/ = -^2 exp {-jt) . (2.36) 

To foster the development of a controller that depends on a desired an- 
gular velocity regression matrix formulation, the following additional linear 
parameterization is designed 

Udf =Ydf(j>2^ f ^Yd(t>2. (2.37) 

In the linear parameterization given in (2.37), the desired regression matrix 
{q,t) ^ R^^^, and the constant parameter vector, denoted by 02 G R^, 



are defined as follows 

— sin (0) 9d — cos (0) 0^ — cos (0) 9d + sin (0) 0^ 0 

^d{q^t) = cos (0) 0^i — sin (0) 0^ — sin (0) 0^i — cos (0) 0^ 0 

0 0 9d _ 

(2.38) 

T 

02= [ mL COS P mL sin P + ] (2.39) 

and Ydf {qp) € R^^^ denotes a desired filtered regression matrix. A mea- 
surable^ prediction error e{t) G R^ can now be defined as follows 

6 = uf- Ydf ^^2 = yf<i> - ydfk ( 2 . 40 ) 



^ Given that f(t) and f(t) are known and that q{t) and q{t) are measurable, it is clear 
from (2.35) and (2.40) that e (t) is measurable. 
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where (2.34) has been utilized. The parameter estimate vector 02 (^) ^ 
given in (2.40) is computed according to the following composite adaptive 
update law 

4>2=PYjje + PYjr (2.41) 

where the inverse of the time- varying gain matrix P (t) G is generated 

according to the following differential expression 

P-^ ^-\P-^+Yj;Yd} (2.42) 

which can also be expressed by the following integral expression 

p-i(t)= p-'^{0)exp(^- J* X{a)da 

(2.43) 

+ ^ exp (- / A ( 77 ) Ylf (a) Ydj {a) da 

where Y^/ (*) is given in (2.37), and \{t) G R is a positive gain-adjusted for- 
getting factor [38] . To facilitate the subsequent control design and stability 
analysis, the expression given in (2.40) can be rewritten as follows 

£ = n -h y^/02 (2.44) 

where Q {q, q, t) G R^ quantifies the mismatch between the filtered torque 
and the desired filtered torque as follows 

Q = Yf(t>-Ydf(p2 (2.45) 

and the parameter estimation error 02 (0 ^ is defined as 

^2 — ^2 ~ ^2’ (2.46) 

Remark 2.2 It is important to note that the sin(0) and cos (9) terms in 
(2.38) can be correctly calculated even if the measured value for6{t) is reset 
every revolution. That is, since we are concerned with the angular velocity 
tracking problem, the control can be implemented by resetting 9{t) each 
revolution, and hence, we can ensure that 9{t) remains bounded. We also 
note that the regression matrix formulation given by (2.38) is crucial for 
developing the persistency of excitation arguments used in the subsequent 
stability analysis. 

Control Formulation 

To develop the open-loop error system for r{t), the same operations as 
given in the previous adaptive control design can be performed to obtain 
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the expression given in (2.21). To facilitate the DCAL-based control devel- 
opment, the linear parameterization Yd{')(t^2 added and subtracted to 
(2.47) to obtain the following expression 

Mr = -Vmr -f Yd(t >2 + X ~ (2.47) 

where the desired regression matrix Yd (•) is defined in (2.38), the parameter 
vector 02 G is defined in (2.39), and the auxiliary term ^ 

is defined as follows 

X-Fi0i-yd02- (2-48) 

To facilitate the subsequent stability analysis, x (^> 4? 0 upper bounded 
as follows (see Lemma B.2 in Appendix B) 

llxll < Cl Ikll (2.49) 

where G M is a known positive bounding constant, and z {t) G R® is 
defined as follows 

z{t)^[x{t) y(t) e{t) (2.50) 

where x(t), y(t), e(t), and r{t) are defined in (2.3), (2.18), and (2.19), 
respectively. Based on the open-loop error system given in (2.47) and (2.48), 
we design the control input u{t) as follows 

u = Yd ^2 + - [ kpix kp 2 V 0 + knClr (2.51) 

where Yd (•) is defined in (2.38), 02 (0 defined in (2.41), Kg and 1 ) ^p2 
are given in (2.23), G M is a positive control gain, and is defined in 
(2.49). After substituting (2.51) into (2.47), the following closed-loop error 
system for r(t) can be obtained 

Mr — -Vmr + Yd^2 + X-Ksr+[kpix kp^y 0 ]^ - (2.52) 

After substituting (2.44) into (2.41) for e (^), the following closed-loop error 
system for 02(0 t>e obtained 

4>2= -PYj^n - PYjfYdf4>2 - PYj r (2.53) 

where the following fact was used 

^2= - k • (2.54) 

The subsequent stability analysis exploits the fact that the mismatch 
term (g, g, t) defined in (2.45) can be upper bounded as follows (see 
Lemma B.3 in Appendix B) 



IPI<7CW 



(2.55) 
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where 7 was defined in (2.33), C ^ is a known positive bounding constant, 
and ip{t) 6 is defined as follows 



i}{t) = 



z^{t) 




(2.56) 



Moreover, the subsequent exponential stability result requires that P~^ (t) 
given in (2.43) be upper and lower bounded by constants. Given the need 
to ensure that P~^ {t) is lower bounded by a constant, the desired filtered 
regression matrix Ydf (•) given in (2.37) is required to satisfy the following 
PE condition ^ 

/’" "Yjf{a)Ydf{a)da>f,h (2.57) 

Jtrr 

where denotes the standard 3x3 identity matrix, and ^ G M is a positive 
bounding constant. Given the need to ensure that P~^ {t) is upper bounded 
by a constant, the forgetting factor A (t) given in (2.42) is defined as follows 
[38] 

A = ^ (fci - ||P||,2) (2.58) 

where Ai, G M are positive constants that represent the maximum forget- 
ting rate and the prespecified bound for the magnitude of the gain matrix 
P{t), respectively, and 11-11^2 denotes the induced 2-norm. 

Remark 2.3 The time-varying design of \{t) given in (2.58) versus a 
simple positive constant is motivated by the desire to achieve the benefits 
of data forgetting while maintaining boundedness of the gain matrix P{t) 
(see the discussion given in [38] regarding data forgetting and an example 
of gain unboundedness when A (t) is selected as a simple positive constant). 



Stability Analysis 

Based on the closed-loop error systems given in (2.52) and (2.53), the fol- 
lowing theorem defines the exponential envelope that confines the transient 
response of the disk tracking error and the parameter estimation error de- 
fined in (2.18) and (2.46), respectively. 

Theorem 2.2 The controller and the composite adaptive update law given 
in (2.41-2.58) ensure that the angular velocity tracking error, the disk cen- 
ter of geometry, and the parameter estimation error are exponentially reg- 
ulated to zero in the following sense 



(Ac -7C). 



11^(0) II" exp 



(2.59) 
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where ip^t) was defined in (2.56). The positive constant parameters (^2 ^ 
R given in (2.59) are defined as follows 



^1 = 



Imin 



^ 777.1 , kpi , kp2 5 



1 -f k\K 1 

r 



C 2 = -^io[iQ,-K{m2,kpi,kp2,k2} , 



(2.60) 



the filter control parameter 7 is given in (2.33), C positive bounding 

constant given in ( 2. 55 ), and Ac G R 25 a positive bounding constant defined 
as follows 

Ac = minjAb, ( 2 - 61 ) 

where X^, G R are positive constants defined as follows 

Xf) — min -[Amin )kpiCk,i,kp2Ck.2^ t , ( 2 . 62 ) 



K = min Amin | [ (^ ^ ( 0 ) ~ 

exp(-Ai (^i_i +^i))| Vi = 2,3,... ,n 




(2.63) 



where (5i G R represents the length of n different time intervals between 
[0,t] (i.e., length of the interval from to to ti is Sq, ti to t 2 is Si,...., t^ to 
tn-\-i is Sn) and Amin {•} denotes the minimum eigenvalue of a matrix. The 
result given in (2.59) can be proven provided that: (i) the desired filtered 
regression matrix Ydf (•) defined in (2.37) satisfies the PE condition given 
in (2.57), (ii) P (0) is selected to be positive- definite symmetric and satisfies 
the following inequality 

P{0)<kih (2.64) 



where k\ was defined in (2.58), and (Hi) the control gain kn of (2.51) and 
7 are selected to satisfy the following sufficient conditions 



kn ^ 



1 

min {Amin } ) hpiOl-i , kp20!-2^ 



(2.65) 



( 2 . 66 ) 



Proof: To prove Theorem 2.2, we define a nonnegative function V{t) e 
as follows 



V = ^r'^Mr + + ^kp^y'^ + 



(2.67) 
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Based on the structure of (2.67), we can use (2.13) and invoke Lemma B.5 
of Appendix B to bound V (t) by the following inequalities 

llV’ll' < ^ < ^2 llV’ll' (2.68) 

where the positive constants ^2 defined in (2.60). After taking the 

time derivative of (2.67), substituting (2.52) into the resulting expression 
for M{q)r (t ) , and then cancelling common terms, the following expression 
is obtained 

V=z ^p22/ 



+kpix(-ri - aix) + kp2y{-r2 - a2y) (2.69) 

+^2 (^/^ + ^2 

where (2.14) and (2.19) have been used. After substituting (2.53) and (2.42) 

into (2.69) for P~^ (t) and ^2 (0> respectively, the following expression is 
obtained 



~ l|2 



V < -r'^Ksr - kpia-ix'^ - kp2a2y'^ - - >d/<?^2 + Ikll llxll 



1 ~,T , 



(2.70) 



-fc„C?r^r+ yrf/^2 - o<^2AP-V2- 



After substituting (2.55) and (2.49) into (2.70) for the bounds for ||fl( )|| 
and l|x( )ll! respectively, the following expression is obtained 



V < -r'^KsT - kpiaix^ - kp20t2y'^ 



1 

2 



y<if^2 




+7C 






after utilizing the fact that 

ll«IIIWI < INI" + 11 ^ 11 " Va,6€K. 



(2.71) 



(2.72) 



After invoking the nonhnear damping argument given in Lemma A. 17 of 
Appendix A to the bracketed terms, an upper bound for (2.71) can be 
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formulated as follows 






min {Amin [K^] ,kpiai,kp‘ 2 .a 2 \ ~ 




^d/^2 +7CilV'll - 






(2.73) 



If the conditions given in (2.57) and (2.64) are satisfied, the following in- 
equalities (see Lemma B.5 of Appendix B for the details regarding the 
development of the following inequalities) 



<M<) 

1 -f" k\K 


(2.74) 


(t) < k2h 
k\ 


(2.75) 


can be used to obtain the following expression 






(2.76) 



where ac is defined in (2.63). Provided that the control parameters 7 and 
kn given in (2.33) and (2.51) are selected according to the conditions given 
in (2.66) and (2.65), we can now use (2.76) to rewrite (2.73) as follows 



v<-Xb\\zf+icmf 




(2.77) 



where was defined in (2.62). We can now express (2.77) in the following 
compact form 

l^<-(Ac-7C)ll^f (2-78) 

after utilizing (2.56) and (2.61). If the control parameter 7 of (2.33) is 
selected to satisfy the sufficient condition given in (2.66), then we can use 
(2.56), (2.67), and (2.78) to prove that r(t), x(t), y{t), and ^2(0 ^ ^00 and 
that e C 2 (see Lemma A.ll of Appendix A). Hence, from (2.56), r(t), 
e(t), and 02(0 ^ ^2 • Since r{t) and 02(0 ^ ^cxd? (2.18), (2.19), and (2.46) 
can be used to determine that e(t), g(t), q{t)^ and 02 (0 ^ ^00 • Since the 
desired regression matrix Yd {’) and its time derivative Yd {') are made up of 
bounded arguments (i.e., q{t), q{t), qd(t), qd{t), Qd ( 0 )j ^an state that 
Yd (•)) Yd (•) G Coo‘ Based on the previous boundedness arguments, (2.51) 
can now be used to prove that u{t) G £00 • From previous arguments and 
the definition of (2.48), we can also prove that x (’) ^ ^00 • H follows from 
(2.52) that r (t) E £00; hence, e (t) and q (t) E Coo- 
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To prove the exponential tracking result given in (2.59), the inequalities 
given in (2.68) can be used to rewrite (2.78) as follows 

y < - ~ V. (2.79) 

^2 

After solving the differential equation given in (2.79) according to Lemma 
A.IO of Appendix A and then utilizing (2.68), the result given in (2.59) is 
obtained. □ 

Remark 2.4 To obtain the inequality given by (2.77), Ydf {') defined in 

(2.37) must satisfy the PE condition given in (2.57) (see Lemma B.5 of 
Appendix B for details). Based on the fact that Td(*)? ^d{‘) ^ 'dje 
can invoke Lemma A. 8 of Appendix A to prove that if Yd{') defined in 

(2.38) satisfies the PE condition, then Ydf (•) will also be PE. Based on the 
knowledge that we would require Yd{-) to satisfy the PE condition, partic- 
ular attention was devoted to the manner in which (2.38) was constructed. 
Specifically, Yd{’) was constructed such that the integrand of the PE con- 
dition takes the following form 

’ + 0 o' 

YlYd= 0 el + Od ^ ■ (2.80) 

_ 0 0 el _ 

It is clear from (2.80) that the desired angular velocity trajectory 9d (t) can 
be designed to ensure that Yd (•) satisfies the PE condition (e.g., Od it) can 
be constructed to be nonconstant for some time interval). 

Remark 2.5 If \{t) defined in (2.42) is selected simply to be a positive 
scalar constant, it is not difficult to show that z (t) defined in (2.50) is 
asymptotically regulated to zero. 

Rem 2 irk 2.6 As indicated by the proof of Theorem 2.2, the exponential 
stability result given by (2.59) requires that P~^{t) be lower bounded by a 
constant (see (2.75)). In [38], a method is presented to develop a lower 
bound for P~^(t); however, it seems that a technical mistake was made 
in the derivation. Given that there does not seem to be a straightforward 
remedy to correct the mistake of [38], an alternative approach to lower 
bound P~^(t) is provided in Lemma B.5 of Appendix B. 

Remark 2.7 As indicated by examining (2.60-2.64), the exponential en- 
velope for the transient performance for 'ip{t) given in (2.59) can be adjusted 
through the selection of the various control parameters. 
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2.2.5 Experimental Setup and Results 

Description of the Experimental Testbed 

The experimental testbed for the auto-balancing control design consists of 
an unbalanced disk with a center of geometry that does not coincide with 
the center of mass (see Figure 2.2). The disk is rotated by a DC motor via 
a belt-pulley transmission coupled with a universal joint and is contained 
within a circular space created by four horseshoe-shaped electromagnets 
forming a large air-gap magnetic bearing assembly (see Figure 2.3 for a 
close-up view of the universal joint and horseshoe-shaped electromagnetic 
assembly). The universal joint is used to ensure uninhibited planar disk 
vibrations. The horseshoe-shaped electromagnetic assembly is used to gen- 
erate the vibration damping forces. An ultra-high intensity (5000 [mcd]) 
light-emitting diode (LED) with a viewing angle of 30 [steradians] is at- 
tached to the center of the free-end position of the rotating disk and is 
measured by two linear charge-coupled device (CCD) cameras which are 
placed at a distance of 0.86 [m] below the LED and are offset from each 
other by 90°. The data provided by the camera is sampled at 2 [kHz] and 
undergoes several stages of hardware and software decoding before the data 
is available as deflection in meters. A high-sensitivity slip-ring is placed at 
the clamped end of the rotor to provide the necessary excitation voltage to 
the LED. 

A Pentium 266 MHz PC running QNX (a real-time micro-kernel-based 
operating system) hosts the control algorithm. The graphical user interface 
Qmotor [11] provides an environment to write the control algorithm in the 
C programming language. It also provides features such as on-line plotting 
and allows the user to vary control gains without recompiling the control 
program. The MultiQ I/O board provides for data transfer between the 
computer subsystem and the electrical interface. Five A/D channels are 
used to sense the currents flowing through the coils of the electromagnets 
and the DC motor. Five D/A channels output voltages that power the 
four electromagnets and drive the DC motor. These voltages go through 
two stages of amplification; the first stage consists of OP07C operational 
amplifiers, while in the second stage, Techron linear power amplifiers source 
a maximum current of 10 [amps] at 100 [volts]. 

A custom-designed software commutation strategy [16] ensures that the 
desired force commanded by the control law is applied to the rotating un- 
balanced disk. Roughly speaking, the commutation strategy involves trans- 
lation of the desired force trajectory into desired current trajectories. To 
ensure that the actual magnetizing currents track the desired current tra- 
jectories, a high-gain current feedback loop is used to apply voltages to 
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the four electromagnets. The four magnetizing currents and the motor cur- 
rent are measured using hall-effect current sensors. The planar and angular 
velocities of the disk were obtained by applying a backwards difference al- 
gorithm, in conjunction with a second-order digital low-pass filter, to the 
LED position measurements obtained from the cameras and to the motor 
angular position measurements obtained from the motor encoder, respec- 
tively. Each of the implemented controllers were executed with a sampling 
period of 0.5 [msec]. 




FIGURE 2.2. Autobalance experimental testbed. 



Description of Experimental Results 

The objective of the experiment presented in this section is to force the 
angular velocity of an unbalanced disk to track a desired velocity profile, 
while driving the planar disk displacements to zero. The desired velocity 
trajectory for each controller (see Figure 2.4) was designed as follows 

{ 400 [rpm] 0 < t < 27 [sec] 

400 — lOcos(t) — 5sin(20t) [rpm] 27 <t < 77 [sec] (2.81) 
400 [rpm] 77 < t < 90 [sec]. 
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FIGURE 2.3. Close-up view of electromagnet assembly and rotating rod with 
universal joint. 

During the interval 27 < t < 77 [sec], the desired trajectory given in (2.81) 
ensures that the regression matrix Yd{') of (2.38) satisfies the PE condi- 
tion of (2.57), thereby allowing a comparison of the parameter estimate 
convergence in the presence and absence of the PE condition. 

Two experiments were performed to compare the performance of the 
DCAL-based controller with an open-loop controller. In the open-loop 
mode, the electromagnets were deenergized. That is, Fx (t) and Fy {t) de- 
fined in (2.5) were set to zero while the control voltage to the motor, denoted 
by Vcm (t) e M, was applied using the following high-gain current feedback 
approach 

Vcm =Tz- Kim (2.82) 

where Tz{t), defined in (2.5), is computed according to the following ex- 
pression 

Tz = e-9d, (2.83) 

/Ct- G M is the torque constant of the motor, and Im (t) G R is the measured 
current in the motor. The open-loop response of the system is given in 
Figure 2.5. Rapid growth in the magnitude of the disk displacement can be 
seen until about 4 [sec] when the disk makes contact and is contained by 
the inside of the magnetic bearing assembly at about ±14 [mm]. 
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To contrast the open-loop response with that of the DCAL-based control 
law, the control design given in (2.51-2.58) was then implemented. Specif- 
ically, the control voltage Vcm (^) was applied using the high-gain current 
feedback strategy given in (2.82), with the exception that Tz (t) was now 
computed according to the DCAL-based control law given in (2.51-2.58). 
To develop the control voltage for the electromagnets, the desired force 
applied by each of the electromagnets was calculated as follows"^ [16] 



fdi = I F, + for i = l,2 (2.84) 



where (t) is the desired control input along the x axis that is com- 
puted from (2.51) and 7 q G M is a small positive constant used to set the 
desired threshold winding current. Based on the desired electromagnetic 
force, the desired current through each of the electromagnets, denoted by 
-^d 2 (^) ^ was developed as follows 



^di — 



Vdi 

(3Li exp {(3x) 



for z = 1 , 2 



(2.85) 



where /3 G R is an experimentally determined constant associated with 
the specific electromagnets utilized in the testbed and Li G M represents 
the inductance of each of the electromagnets of the magnetic bearing as- 
sembly. The voltage applied to each of the electromagnets, denoted by 
Vo2(t) ^ R, can then be applied using high-gain current feedback as 

follows 



Voi = ke {Idi - It) for i = 1, 2 (2.86) 



where A (t) , I2 (t) G R are the measured currents through each of the coils 
and /cg G R is a positive control gain. The gains that resulted in the best 



'^Here, we have only presented the control implementation for the x-axis. The y-axis 
is similar. 
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closed-loop performance are given below 

“ 10.0 0 0 “ 

P{0)= 0 10.0 0 

_ 0 0 0.1 . 

7 o = 0.001 0 = 60 Li= 0.0002 

a == diag {1.2, 1.2, 0} Kp = diag (0.1, 0.1, 0} 
Ks = diag (2.8, 2.8, 1.0} K = 2.0 7 - 2.5 



(2.87) 



ke = 1.6 ki = 10.0 Ai - 0.1. 

Figure 2.6 shows the disk displacements along the x and y axes. Notice 
that the peak closed-loop error with the adaptive controller is about ±2.3 
[mm], which is approximately 17% of the peak open-loop error. Figure 2.4 
shows the angular velocity tracking error for the adaptive controller (the 
open-loop angular velocity tracking error response is similar to that of the 
adaptive controller and, hence, was not shown). As illustrated in Figure 
2.7, during the time interval when the desired angular velocity satisfies the 
PE condition, the parameter estimates converge to different values. 

The adaptive controller was also implemented with the following more 
aggressive desired velocity trajectory 

( 900 [rpm] 0 < t < 27 [sec] 

6d[t) = < 900 — 50cos(t) — 10sin(20t) [rpm] 27 <t <77 [sec] 

[ 900 [rpm] 77 <t< 100 [sec], 

( 2 . 88 ) 

with control gains similar to those used for the 400 [rpm] trajectory. The 
results for the trajectory given in (2.88) are given in Figures 2.8-2.10. 
As illustrated by these figures, the closed-loop response when the desired 
velocity trajectory is given by (2.88) is similar to that obtained with the 
trajectory given in (2.81). 
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FIGURE 2.4. Desired motor velocity trajectory and motor velocity tracking 
at 400 [rpm]. 
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FIGURE 2.5. Open-loop performance of the disk displacement along the 
and y — axis at 400 [rpm]. 
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FIGURE 2.6. Adaptive controller performance of the disk displacement along the 
X — and y — axis at 400 [rpm]. 
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FIGURE 2.7. Parameter estimates for the adaptive controller at 400 [rpm] : (a) 
mLsin(j3), (b) mLcos(/3), and (c) 7cm + 2mL^. 
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FIGURE 2.8. Desired motor velocity trajectory and motor velocity tracking error 
at 900 [rpm]. 
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FIGURE 2.9. Adaptive controller performance of the disk displacement along the 
X — and y — axis at 900 [rpm]. 
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x10’“ c) 




FIGURE 2.10. Parameter estimates for the adaptive controller at 900 [rpm] : (a) 
mL sin (/?), (b) mL cos (/?), and (c) Icm + 2mL^. 

2.3 Dynamically Positioned Ships 

In this section, two adaptive controllers are developed for dynamically 
positioned ships. The first controller uses a standard full-state feedback 
gradient-based adaptive update law. Based on the desire to eliminate ve- 
locity measurements, the second controller leverages off of recent results 
in the area of global adaptive output feedback control of robot manipula- 
tors [44, 46]. Specifically, the second controller is composed of an adaptive 
feedforward term that depends on the desired ship trajectory, a nonlinear 
feedback term, and a nonlinear filter that generates a surrogate velocity 
signal. Both controllers provide global asymptotic position tracking while 
compensating for parametric uncertainty in the ship dynamics. To prove the 
global adaptive output feedback tracking result for the second controller, 
an innovative nonquadratic Lyapunov function is used. 



2.3.1 System Model 

The dynamic and kinematic models for thruster-driven dynamically posi- 
tioned ships can be written as follows [19, 29] 



Miy -h Du -f Krj = r 



(2.89) 
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Yc 



FIGURE 2.11. Ship coordinate frames. 

fj = R{^)u (2.90) 

where u(t) G represent the ship velocity and acceleration, respec- 
tively, relative to the body-fixed coordinate frame and r]{t) G E^ 

is defined in terms of the ship translational position, denoted by x(t)^ 
y(t) G E, and the yaw angle, denoted by '0(t) G E, relative to an Earth-fixed 
coordinate frame [Xe^Ye] as follows (see Figure 2.11) 

T]=[ X y V’ ]^- (2-91) 

The constant positive-definite and symmetric mass-inertia matrix M G 
E3x 3 constant damping matrix D G E^^^ given in (2.89) are 

defined as follows 

mil 0 O' ’ dll 0 0 ' 

M = 0 77122 ^23 D = 0 d22 ^23 , (2.92) 

0 77123 ^33 _ _ 0 ^32 ^33 

K = diag{/ci, /c 2 , /C 3 } G E^^^ is a diagonal matrix representing the mooring 
forces, and r{t) G E^ represents the control force/ torque input vector pro- 
vided by the thruster system. The matrix^ ^(V^) ^ SO (3) given in (2.90) 

^'’The set of all 3 x 3 rotation matrices is usually referred to as 50(3) (Special Or- 
thogonal group of order (3)) [25]. 
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represents the rotation between the Earth and body-fixed coordinate frames 
that is defined as follows 



RW = 



COS('0) 

sin('0) 

0 



— sin('0) 
cos{'ip) 



0 



0 ■ 
0 
1 



(2.93) 



To facilitate the subsequent control design and stability analysis, (2.89), 
(2.90), and the fact that 

R-\ip) ^ (2.94) 



are used to rewrite the dynamic model for the thruster-driven dynamically 
positioned ship in the following form 



M*T] + Vm'h + FlV + F2T] — T* (2.95) 

where the transformed dynamics given in (2.95) are related to (2.89) and 
(2.90) through the following expressions 

M*(t 7) = RMR^ fj) = RMR^ 



(2.96) 

Fi(r?) = RDR^ F 2 {t]) = RK r*{t) = Rr. 

Similar to the dynamic model of the rotating unbalanced disk, the structure 
of the dynamic model in (2.95) exhibits several properties that will be 
utilized in the subsequent control development and stability analysis. 

Property 2.4: Symmetric and Positive-Definite Inertia Matrix 



The transformed symmetric and positive-definite mass-inertia matrix 
M* (rj) given in (2.96) satisfies the following inequalities 

mi ll^f < < m2 ||.ef e (2.97) 

where mi, m2 G R are known positive constants, and H-H denotes the 
standard Euclidean norm. 



Property 2.5: Skew-Symmetry 

The transformed dynamic terms M*(t 7 ) and Kn(^,^) given in (2.96) sat- 
isfy the following skew-symmetric relationship 

f (1m* - 4 ^^) ^ = 0 Ve G (2.98) 

where M*{q) denotes the time derivative of the transformed inertia matrix. 
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Property 2.6: Switching Property 

The matrix Vmixj^f]) (2.96) satisfies the following relationship 

Vm{rj^ = Vm{ri^ ^ (2.99) 

Property 2.7: Bounding Inequalities 

The norm of ^i(^) can be upper bounded as follows 

\\Vm(v,v)\\ioo ^CvlM\ ( 2 . 100 ) 

ll^’i(»7)ll,oc<C/i (2.101) 

where Cvi>C/i ^ ^ ^re known positive bounding constants, and \\-\\i^ de- 
notes the induced infinity norm. The following bounds are also valid for 
Vu,u; G (see Section B.1.5 of Appendix B for the proofs) 

\\M*{u) - II Tank (u - t«)|| 

l|Kn(u,i7) - Kn(-w,5?)||ioo ^ Cv2 ll’ill |1 Tan/i (u - u;) || (2.102) 

||Fi(u) - Fi(w)|| < C/2 \\Tanh {u - iti)|| 

where C/2 ^ ^ some positive bounding constants, and the 

vector function Tanh{-) G R^ is defined as follows 

Tank {a) = [tanh(ai), tanh(u2), tanh(as)]^ Va = [ai,a2,a3]^ . (2.103) 

Property 2.8 Linearity in the Parameters 

The dynamics given in (2.96) can be linearly parameterized as follows 

Ys(t> = M^rj + Vmf] + Fifj (2.104) 

where Ys{r],f],^) G R^^^ denotes a measurable regression matrix, and 0 G 
R^ denotes the constant system parameter vector defined as 

(t> =[ mil m22 m23 m^s du g ?22 ^23 d^2 (2.105) 

2.3.2 Adaptive Full-State Feedback Control 

The objective of this section is to design a global position tracking con- 
troller for the dynamically positioned ship model given by (2.95) despite 
parametric uncertainty in the nonlinear ship dynamics where rj(t), f]{t) are 
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assumed to be measurable. To quantify the ship position tracking perfor- 
mance, a position tracking error e{t) G is defined as follows 

e = Vd-V (2.106) 

where S R® represents the ship’s desired position trajectory that 

must be constructed such that rj^ (t) G Coo- ^ similar 

manner as in the previous section, a filtered tracking error is defined as 
follows 

r = e-\-ae (2.107) 

where a G is a control gain matrix given by the following expression 

a = diag{ai,a2,a3} (2.108) 

where ai, 0 : 2 , as G M are positive control gains. 

Control Formulation 

To develop the open-loop error system for r(t), we take the time deriva- 
tive of (2.107), premultiply the resulting expression by M*(? 7 ), and then 
substitute (2.95) for M*{r])r]{t) to obtain the following expression 

M*r - -Knr -f - r* (2.109) 

where Y {rj,r]^t) G denotes a measurable regression matrix such that 

Yct> = M* (i)d + ae) + Fm (i?d + ae) + Fifj + F2T] (2.110) 

where (j> is given in (2.105), and (2.106) and (2.107) have been used. Based 
on the structure of the open-loop error dynamics given in (2.109) and the 
subsequent stability analysis, we design the control input r*(t) as follows 

r* =Y^^Ksr + Kpe ( 2 . 111 ) 

where ^(t) G R^ denotes a parameter estimate vector for cf) that is generated 
according to the following gradient update law 

-TY^r (2.112) 

where T, and Kp G R^^^ denote positive-definite control gain matrices 
defined as follows 

r = diag{ri,r2,r3} 

Ks = diag{/c5i,/cs2,A:s3} (2.113) 

Kp — diag {/cpi , kp 2 , • 




52 



2. Mechanical Systems 



After substituting (2.111) into (2.109), the following closed-loop error sys- 
tem is obtained 

M*f = -Vrav + - Ksv - Kpe (2.114) 

where the parameter estimation error ^ (t) G is defined as follows 

0 = 0-0. (2.115) 



Stability Analysis 

The stability of the adaptive ship position tracking controller given in 
(2.111) and (2.112) can be examined through the following theorem. 

Theorem 2.3 The controller given by (2.111) along with the adaptive up- 
date law given in (2.112) ensures global asymptotic ship position tracking 
in the sense that 

lim e{t) = 0 (2.116) 

f— >oo 

where e(t) was defined in (2.106). 

Proof: To prove Theorem 2.3, we define a nonnegative function V{t) G M 
as follows 

V = lr^M*r + ^e'^Kpe + (2.117) 

After taking the time derivative of (2.117), substituting (2.114) into the re- 
sulting expression for M*{r])r (t), substituting the time derivative of (2.115) 

for 0 (t), and then cancelling common terms, the following expression can 
be obtained 

V = -r^K,r - e'^Kpae (2.118) 

where (2.98) and (2.107) have been used. Prom (2.117) and (2.118), it 
is clear that r(t), e(t), 0(t) G Coo and that e(t), r(t) G £2 (see Lemma 
A. 11 of Appendix A). Since r{t) G £005 Lemma A. 13 of Appendix A can 
be used along with (2.106) and (2.107) to prove that e(t), rj{t), r]{t) G 
Coo] furthermore, (2.115) can be used to prove that 0(t) G £00 • Since the 
regression matrix T (•) is made up of bounded arguments, we can state 
that Y (•) G Coo] therefore, (2.111) can be used to prove that the control 
input u{t) G £00 • If follows from (2.114) that r (t) G Coo] hence, e(t) 
and T){t) G Coo> Based on the facts that r(t), r (t) G £00 and r{t) G £ 2 , 
Barbalat’s Lemma (see Lemma A. 16 of Appendix A) can now be invoked 
to prove that 

lim r{t) = 0. (2.119) 

t-^00 

The condition (2.119) and Lemma A. 15 of Appendix A can now be utilized 
to prove the result given in (2.28). Alternatively, the expression in (2.119), 
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e(t), e{t) G Coo e{t) G C 2 , and Barbalat’s Lemma can now be utilized 
to prove the result given in (2.116). □ 



2.3.3 Adaptive Output Feedback Control 

In the previous section, the fact that full-state feedback was available for 
the control design (i.e., of (2.111) depends on rj{t)^r]{t)) was exploited. 
However, for many mechanical systems the requirement for velocity mea- 
surements is undesirable due to increased cost/complexity of an additional 
sensor and the added noise that is inherent to velocity measurements. 
Hence, motivation exists to develop output feedback controllers that only 
require the measurement of the output signal (e.g., the ship position r]{t) 
in this application). Given this motivation, the objective of this section is 
to design a global adaptive position tracking controller for the dynamically 
positioned ship given in (2.95) despite the additional constraint that only 
the ship position rj{t) is available for measurement. To achieve a global 
stability result for the subsequent adaptive output feedback controller, the 
dynamic model given in (2.95) must be simplified by neglecting the mooring 
effects. That is, if the mooring effects are included in the dynamic model 
then the result degrades to a semi-global stability result (see the discussion 
provided in the subsequent Remarks 2.10 and 2.13). 

To facilitate the output feedback control design and the stability analysis, 
a new filtered tracking error signal, denoted by r{t) G is defined as 
follows 

r = e-j- Tank (e) + 2 (2.120) 



where e{t) was defined in (2.106). The velocity-related tracking error signal 
z(t) = [2^1, 22,^3]^ given in (2.120) is defined by the following dynamic 
nonlinear filter 

Zi—pi-kcei ( 2 . 121 ) 



Pi = 



- (1 - {Pi - Keif‘S {pi - kc6i - tanh (e^)) 
-kc (tanh (e^) + Pi - kcSi) 



( 2 . 122 ) 



where kc G R denotes a positive constant filter gain, and pi(t) G R is a 
filter variable that is initialized to satisfy the following inequalities 



+ kcei(0) < pi(0) < -h kcei(O) Vz = 1,2,3. (2.123) 

v3 v3 



Based on the development given in (2.120-2.123), the dynamics for the 
velocity-related tracking error signal can be obtained by taking the time 
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derivative of (2.121) as follows 

Zi = -(1 - zf)^{zi - tanh(ei)) - 

lzi(0)|<^ Vi = 1,2,3 
where (2.122) was utilized. 



(2.124) 



Remark 2.8 Based on the definition for the filtered tracking error signal 
given in (2.120), it is clear that from (2.106) that r{t) depends on r]{t). 
The control objective in this section is targeted at the output feedback con- 
trol problem, and hence, 'q{t), r{t), and Zi{t) are not measurable signals. 
Although it cannot be directly used in the subsequent controller, the filtered 
tracking error signal facilitates the subsequent control development and sta- 
bility analysis. 



Control Formulation 

To develop the open- loop error system for r(t), we take the time derivative 
of (2.120), premultiply the resulting expression by and then sub- 

stitute (2.95) for M*{r])T)(t) (with the mooring effects neglected) to obtain 
the following expression 

M*r = M*fi^ + Vmf] + Fir] - t* + M* Cosh~‘^ (e) e + M*z (2.125) 

where the matrix function Cosh{-) £ is defined as follows 

Cosh{e) — diag{cosh(ei),cosh(e2),cosh(e3)} Ve = [ei, e^, 63]^ e 

(2.126) 

To facilitate the subsequent analysis, a desired linear parameterization is 
defined as follows 

Yd4> = M*{r]j)T]d + VmiVd,Vd)Vd + FiiVd)Vd (2.127) 

where Yd{t) 6 R^^p denotes a desired regression matrix, and the constant 
unknown parameter vector (j) is given in (2.105). After adding and subtract- 
ing (2.127) and the product fo (2.125), the open-loop dynamics 

for r{t) can be formulated as follows 



M*r = -VmT + - r* - k^M^r + T + x ( 2 . 128 ) 

where (2.106), (2.120), and (2.124) were used. In (2.128), the auxiliary 
terms Y (e, z, ry, t), x (^^ -2:, rj, t) G are defined as follows 



Y = M*{r])Tid + Vmiv,f]d)f]d + Fi{t])t] - Yd(j) 



(2.129) 
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and 

X = M*{ri)Cosh-‘^ (e) (r - Tanh{e) - z) - M*{t])T (z - Tanh(e)) 
+Vm(V! Vd + Tanh{e) + z) ( Tanh(e) + z) 

+Vm(v,Vd) (Tanh(e) + z) - Vm(T},r) + Tanh{e) + z) . 

(2.130) 

Based on the open-loop dynamics for r{t) given in (2.128), the following 
adaptive output feedback tracking control law is developed 

T* = - k^T-^z + Tanh{e) (2.131) 

where fcc € M is a positive control gain, and the matrix T{z) € is 

defined as 

T{z) =diag|(l- 2 ?)^,(l- 2 f)^,(l- 2 :|)^| (2.132) 

where z{t) is defined in (2.121). The parameter estimate G given 
in (2.131) is generated by the following gradient adaptation law 

0= r / Yj{r]d{(^),'tid{(T),Vd{(^)){Tanh{e{a)) + z{a))da 
Jo 

(2.133) 

-r f Yj (rjd(o-), (cr), T)d {<j))e{<j)da Y TYJ e 
Jo 

where F G denotes a constant diagonal positive-definite adaptation 

gain matrix. 

After substituting the control law given in (2.131) into (2.128), the fol- 
lowing closed-loop dynamics for r{t) are obtained 

M*r - -Vmv + + kcT~^z - Tanh{e) - k^M^r + F + % (2.134) 

where (2.115) was used. After differentiating (2.115) and (2.133), the fol- 
lowing dynamic relationship for the parameter estimation error can also be 
developed 

4>= -TYjr (2.135) 

where (2.120) has been utilized. 

Remark 2.9 As proven by Lemma B.9 of Appendix B, (2.97), (2.100), 
several trigonometric identities, and the boundedness properties of the de- 
sired trajectory can be used to prove that x{') of (2.130) can be upper 
bounded as follows 




56 



2. Mechanical Systems 



where the composite state vector g{t) G is defined as 

g=[r'^ Tanh^{e) z'^ (2.137) 

and (^- G M, i = are known positive bounding constants that depend 

on the system parameters and the desired trajectory. Furthermore, by sub- 
stituting (2.127) into (2.129) for Yd{‘)(l) and then using (2.101), (2.102), 
(2.106), and (2.120), it can be shown that Y (•) of (2.129) can be upper 
bounded as follows 

|^||<C7IIP|I (2-138) 

where ^7 G M 25 a known positive constant depending on the system para- 
meters and the desired trajectory. 

Remark 2.10 To develop the bound for Y (e,z,r],t) given in (2.138), the 
mooring effects of (2.95) must be neglected because the mooring effects given 
by F2 {t]) t] cannot be upper bounded by a function of g(t). Specifically, the 
norm of the mismatch between the desired mooring term and the actual 
mooring effect given below 

F2{T])v-F2{Vd)Vd (2-139) 

can only be upper bounded in terms of e{t) as follows 

\\F2 (v)v- F 2 iVd)Vd\\ < Cs l|e|| + C9 \\Tanh{e)\\ (2.140) 

where (g G R are positive bounding constants that depend on the system 
parameters and the desired trajectory. That is, since 

||e|| > \\Tanh(e)\\ , (2.141) 

the norm of the mismatch given in (2.140) can not be upper bounded in 
terms of g{t) as in (2.138). 

Stability Analysis 

The stability of the adaptive output feedback ship position tracking con- 
troller given in (2.121), (2.123), (2.131), and (2.133) can be examined 
through the following theorem. 

Theorem 2.4 Given the ship dynamics of (2.95), the adaptive output feed- 
back tracking controller of (2.121), (2.123), (2.131), and (2.133) ensures 
global asymptotic tracking in the sense that 

lim r(t), z(t), e(t) = 0 

t—^oo 



(2.142) 
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in the region 

x E^j (2.143) 

provided the control gain kc given in (2.131) is selected as follows 

kc = — + kn (Cl + Cr)^ + + 8 Ci + 4Cl + I 6 C 5 + Ce) (2.144) 

where rui is given in (2.97), i = were defined in (2.136) and 

(2.138), and kn is an additional control gain selected to satisfy the following 
sufficient condition 

kn > 2. (2.145) 

Proof: To prove Theorem 2.4, we define a nonnegative function V{t) eR 
as follows 

V = i ^ + ^ln(cosh(ei)) + (2-146) 

4=1 * 4 = 1 

where ln(cosh(ei)) is positive-definite and radially unbounded, and the 
function is positive-definite and radially unbounded on the interval 
[—1,1]; hence, V{t) is a positive-definite radially unbounded function in the 
set 

5 = { (r, z, e) e E^ X EP X [-1, 1]^ x E^} . (2.147) 

After taking the time derivative of (2.146), utilizing (2.98), (2.120), (2.124), 
(2.134), and (2.135) and then cancelling the common terms, the following 
expression can be obtained 

3 3 

l/ = r^(-fceMV + y + x) 

4 = 1 4 = 1 

After using (2.136) and (2.138) and substituting (2.144) into (2.148) for kc, 
the following upper bound can be obtained 

V< -\\rf-\\zf-\\Tanh{e)f 

+ [(Ci + C7)ll^ll IH|-fcn(Ci+C7)'llrf 

+ [C2 Ikll" Ikll - 16d l|pf ] + [C3 Ikll" Ikll - 8Cl llr-ll"] (2.149) 

+ [C4 INII" Ikll - 4Cl Iklp] + [Cs Ikll" Ikll - i6d Ikll"' 



+C6(INI-i)IMP- 




58 



2. Mechanical Systems 



After completing the squares on the bracketed terms of (2.149), we can 
further upper bound V{t) as follows 



v< + f IldlVlyziP 



-^ + 1\\4" + \W4" 



(2.150) 






i|rf + l||z|l® 



+C6[ii^ii-i] ikir 



where (2.137) was utilized. If kn is selected according to (2.145), then 
(2.150) can be utilized to prove the following inequality 



V < — /3||^||^ if lk(0ll < 1 Vt > 0 



(2.151) 



where /? is a positive constant that satisfies the following inequality 



0 </ 3 < 2 - 

Based on (2.151), the following inequality can be utilized 

llzlP < 3 max 



X X 



- 1 . 1 V 



to define the following set 

hence, (2.151) can be written as follows 

V^-^WqW^ if {r,^,z,e^ € Si. 



(2.152) 



(2.153) 



(2.154) 



(2.155) 



Since Si C 5, where S was defined in (2.147), the region of attraction will 
contain the largest level set of V{t) inside the set S\. Since all level sets 
of V{t) are contained inside 5, then S\ is invariant and an estimate of the 
stability region. Hence, for initial conditions inside 5i, (2.146) and (2.155) 
can be used to prove that p(t), e(^), ^(t) e Coo ^nd that g(t) e C 2 (see 
Lemma A. 11 of Appendix A). Based on the fact that € Coo^ (2.115) 
can be used to prove that ^{t) G Coo- Given that g{t) G £005 (2.137) can 
be used to prove that r(t), z{t) e Coo- Since e(t), r(t), z{t) G £005 (2.106), 
(2.120), (2.121), (2.124), and the assumption that ry^(t) G Coo can be used 
to prove that rj{t), Pi(t), Pi{t), e(t), z{t) G Coo- The previous development 
indicates that 



1 
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Prom (2.132) and (2.156), we can prove that T{z), T~^{z) G £oo- Based on 
the fact that are assumed to be bounded, (2.127-2.131) 

can be used to prove that Yd{t), F(-), x(*)j ^ ^oo* Since r(t), 

e(t), z{t) G Coo, the definition given in (2.137) can be used to prove that 
g{t) G Coo] hence, Barbalat’s Lemma (see Lemma A. 16 of Appendix A) 
can be invoked to prove that 



^lii^ g{t) =0 if ^r, 0, 2, e Si. (2.157) 

Based on the definition of g(t) given in (2.137), (2.157) can be used to prove 
that 

^lim r{t), z(t), Tanh{e{t)) = 0 (2.158) 

in the region 



Based on the fact that 



1 1 \ ^ 

GM^xRPx f ) xR3 

V3 V3j 



lim e(t) = 0 

t-^00 ^ ^ 



is a necessary condition for 



lim Tanh(e(t)) = 0, 

t — >00 



(2.159) 

(2.160) 
(2.161) 



the result given in (2.142) can now be obtained. □ 



Remark 2.11 Despite the initial condition restriction for the filter sig- 
nal z(t) given in (2.124), the stability result is still global for the posi- 
tion tracking error e{t) since no restrictions are placed on the size of 
||e(0)|| (see (2.143)). Moreover, no restrictions are placed on the size of 
||r(0)||, ^(0) , and ||e(0)||. Based on the control structure given by (2.121 ), 
(2.123), (2.131), and (2.133), we note that the initial conditions of the filter 
only need to be adjusted relative to the measurable quantity e(0). 



Remark 2.12 As in [29], the dynamic model presented in (2.89) (with the 
mooring effects neglected) can be modified to include a bias term represent- 
ing drift, currents, and wave load as follows 



MV + Du — R{^)b = r (2.162) 

where 6 G an unknown constant vector. Given the model modifica- 

tion of (2.162), the adaptive output feedback tracking controller of (2.121), 
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(2.123), (2.131), and (2.133) can he easily extended by adding an additional 
term to r*(t) of (2.131) as follows 

r* = Ydcj) - KT-^z + Tanh{e) -b (2.163) 

where the estimate b{t) is updated as follows 

b= — F 2 [ (Tanh{e{a)) -f z{a))da — F 2 e (2.164) 

Jo 

where T 2 € is a constant diagonal positive- definite adaptation gain 

matrix. 

Remark 2.13 If the thruster- assisted mooring effects are included in the 
dynamic model for the global adaptive output feedback control section, some 
extra terms will be present that will change the bounds given in (2.138) for 
Y (t) (see the comments in Remark 2.10). If the thruster- assisted mooring 
effects are incorporated in the model as in the previous full-state feedback de- 
sign, a control design methodology similar to the one of [5] could be followed 
to construct a semi- global adaptive output feedback tracking controller. 

2.3.4 Simulation Results 

To simulate the adaptive output feedback controller, a ship model with the 
following mass-inertia and damping matrices was used [20] 

■ 1.0852 0 0 

M = 0 2.0575 -0.4087 

_ 0 -0.4087 0.2153 

(2.165) 

■ 0.08656 0 0 

D= 0 0.0762 0.1510 . 

_ 0 0.0151 0.0031 _ 

The desired position trajectory for the ship was selected as follows 

rjd{t) = [10sin(0.2^) [m], 10cos(0.2it) [m], 5sin(0.2^) [rad]]^ . (2.166) 

The initial conditions for the ship position 7/(0) were selected as 

t;( 0) = [1 [m], -1 [m], 1 [rad]]^ (2.167) 

and the initial condition for the ship velocity rj{0), the velocity-related 
tracking error signal 2 ^( 0 ), and parameter estimate 0(0) were all set to zero. 
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The control and adaptation gains were selected as follows® 

kc = diag{20, 40, 50} T = diag{35, 50, 250, 280, 50, 100, 200, 400, 600}. 

(2.168) 

Figure 2.12 illustrates the position tracking error performance while the 
control inputs are shown in Figure 2.13. The parameter estimates for the 
inertia and damping parameters are presented in Figures 2.14 and 2.15, 
respectively. 




Time [sec] 



FIGURE 2.12. Position tracking errors. 



®The stability analysis required that the gain kc be defined as a scalar; however, kc 
was defined as a matrix during the simulation. Although we cannot theoretically justify 
this modification, we have verified from experience that it usually improves the tracking 
performance in numerical simulations and real-time implementations. 




62 



2. M 




FIGURE 



Torque Input 2[Nt-m] Torque Input 1 [Nt-m] 
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FIGURE 2.15. Parameter estimates for the entries of the damping matrix. 

2.4 Euler-Lagrange Systems 

A task space-based tracking controller for general Euler-Lagrange systems 
is formulated in this section. To eliminate singularity problems associated 
with some of the three-parameter task space formulations, as outlined in 
the introduction of this chapter, the orientation of a coordinate frame fixed 
to a mass is expressed in terms of the unit quaternion, and thereby, the 
orientation tracking error problem is formulated as commonly done in ori- 
entation (i.e., attitude) control problems^ [3, 12, 27]. To demonstrate how 
the control design methodology for general Euler-Lagrange systems can be 
formulated to target a specific example, a unit quaternion-based controller 
for fully actuated UUVs is designed. 

2.4.1 System Model 

Kinematic Model 

Let £ and B be orthogonal coordinate frames attached to the body mass 
of a general Euler-Lagrange system and the inertial frame, respectively. 



^Note that most task space robotic controllers formulate the orientation error ac- 
cording to the classical operational space approach [6] of taking the algebraic difference 
between the desired and actual Euler angles (see, for example, [45]). 
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The position and orientation of £ relative to B are commonly represented 
by a homogeneous transformation matrix that is expressed in terms of a 
generalized coordinate system. From this homogeneous transformation ma- 
trix, several different representations can be used to develop the kinematic 
model, including three-parameter representations (e.g., the Euler angles, 
Gibbs vector. Cay ley- Rodrigues parameters, and Modified Rodrigues para- 
meters) and the constrained four-parameter unit quaternion representation. 
In this section, the unit quaternion parameterization is used to provide a 
global nonsingular parameterization of the orientation of £ with respect to 
B. To facilitate the unit quaternion parameterization, Euler’s theorem is 
used to note that any rotation matrix can be uniquely represented by a 
rotation of angle ip{t) € M about a suitable unit vector k(t) G (i.e., the 
axis-angle representation [26, 40]). Thus, given a rotation matrix in terms 
of a generalized coordinate system, the angle-axis parameters (cp, k) can be 
easily calculated (e.g., the algorithm given in [40] could be utilized). Given 
((^, /c), an alternative parameterization of the orientation of £ with respect 
to B is provided by the unit quaternion vector q(t) =[g'o(0j ^ 

with go(0 ^ ^ Qv{t) G R^ as follows 



q{t)^ 



qv{t) 



cos 



2 



k{t) sin 



2 



(2.169) 



where it is clear from (2.169) that the unit quaternion is subject to the 
following constraint 

q'^q = l. (2.170) 

To develop the unit quaternion parameterization given in (2.169), a rotation 
matrix expressed in terms of a generalized coordinate system was utilized. 
Given the unit quaternion parameterization, the rotation matrix can be 
expressed in terms of the unit quaternion as follows [27] 

R (q) ^ {Qo - qIqv) h + + ^qoqv (2.i7i) 

where is the 3x3 identity matrix, and the notation denotes the 
following skew-symmetric matrix 



Qv 



0 —qv3 Qv2 

Qv3 0 qyi 

Qv2 Qvl 0 



'^qv = [qvl, qv2, qvsf ■ (2.172) 
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Given the previous development, a relationship between the position and 
orientation of £ relative to B can be developed as follows [27] 



’ V ‘ 




■ /p(^) ■ 


. q . 




. m . 



(2.173) 



where fp{6) G and fq{0) G R^ are kinematic functions, 0{t) G R’^ 
denotes the position of f in a generalized coordinate system, p{6) G R^ 
represents the position of the origin of £ with respect to the origin of B, 
and the unit quaternion was defined in (2.169). After differentiating (2.173), 
the following velocity relationships can be formulated [27] 



' P ' 




■ Jp(0) ■ 


. Q . 







(2.174) 



where 6(t) G R^ denotes the velocity of f in a generalized coordinate sys- 
tem, and Jp{0) G R^^^, Jq{6) G R^^'^ denote the position and orientation 
Jacobian matrices, respectively, that are defined as follows 

j j (2 175) 

To facilitate the subsequent control development and stability analysis, 
the fact that q{t) is related to the angular velocity of £ relative to S, 
denoted by u{t) G R^ with coordinates expressed in S, via the following 
differential equation [3, 27] is exploited 



(2.177) 



q = B{q)u (2.176) 

where the Jacobian- type matrix B{q) is defined as follows 

B(a) = i [ 

2[qoh-q^ 

where B{q) satisfies the following useful property (see Lemma B.ll of Ap- 
pendix B) 

B^{q)B{q) - h. (2.178) 

Based on (2.178), we can rewrite (2.176) as follows 

CJ = B^{q)q. (2.179) 



After combining (2.174) and (2.179), the final kinematic expression that 
relates the generalized Cartesian velocity to the generalized coordinate sys- 
tem is developed as follows 



u 



= j{6)e 



(2.180) 
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where the Jacobian matrix J{9) G is defined by the following expres- 
sion 



j{e) = 



Jp{0) 



(2.181) 



For some systems (e.g., redundant robot manipulators), the Jacobian 
given in (2.181) may have more columns than rows. Since the Jacobian 
may be nonsquare, we will exploit the use of the pseudo-inverse of the 
Jacobian in the subsequent development. Specifically, the pseudo-inverse 
of J(^), denoted by J~^{0) G is defined as follows 



j+ = j^(jjq ^ such that JJ+ = h- (2.182) 



As shown in [32], the pseudo-inverse given in (2.182) satisfies the Moore- 
Penrose Conditions given below 



JJ+J = J J+JJ+ = J+ 



{j+jf ^ j+j {jj+f = JJ+. 



(2.183) 



In addition, the matrix In — J, which projects vectors onto the null space 
of J(0), satisfies the following properties 

(In - J+J) {In - J+J) =In-J^J J {In ~ J) - 0 

{In - J+Jf = {In - J^J) {In ~ J+J) J+ = 0. ^ ' '' 



Remark 2.14 During the subsequent control development, we assume that 

the minimum singular value of J {9) is greater than a known small positive 

constant 6 > 0, such that sup {|| J~'~(0)||} is known a priori, and hence, all 

0 

kinematic singularities are always avoided, where the notation sup{-} is 

e 



used to denote the supreme value over all 9. 



Remark 2.15 As an example of how the previous development can be ap- 
plied to a particular Euler- Lagrange system, consider an n-link robot ma- 
nipulator. In the robotics literature, the position and orientation of the 
end-effector of a robot manipulator are commonly related to the manipu- 
lator base through a homogeneous transformation matrix. Specifically, by 
using the Denavit-Hartenberg representation, the transformation matrix 
T{9) G R!^^^ can be calculated as follows [26, 40] 



T{6) = 



R{6) P{0) 

0lx3 1 



(2.185) 



where Oixs = [0 0 0], 9{t) G denotes a vector of manipulator link po- 
sitions, p{9) G R^ represents the position of the origin of the end-effector 
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with respect to the manipulator base, and R{0) G 50(3) represents the 
rotation of the coordinate frame attached to the end-effector with respect 
to the base coordinate frame. Given (2.185), three-parameter representa- 
tions are typically utilized to develop the forward kinematic model of the 
manipulator. As demonstrated in the previous development, the homoge- 
neous transformation in (2.185) can be utilized along with Euler ^s theorem 
to obtain (2.169), and hence, the forward kinematic model can be developed 
using the four-parameter unit quaternion representation as demonstrated 
in the previous development. 

Dynamic Model 

The dynamic model for a generalized Euler-Lagrange system is assumed to 
have the following form 

M{6)e + Vm{6,e)e + G{e) + - r (2.186) 

where 9{t) was given in (2.173), and 6{t), 6{t) G denote the velocity and 
acceleration of E in terms of the generalized coordinate system, respectively. 
For the dynamic model given in (2.186), M{0) G R^^’^ represents the 
inertia matrix, Vm{9, 6) G R^^'^ is the centripetal-Coriolis matrix, G{6) G 
R’^ represents the gravity effects, Fd G is a diagonal matrix that 

contains the constant viscous friction coefficients, and r(t) G R’^ represents 
the control input vector. As in the previous sections, the subsequent control 
design and stability analysis will exploit the facts that the dynamic model 
given in (2.186) satisfies the following properties. 

Property 2.9: Symmetric and Positive-Definite Inertia Matrix 

The symmetric and positive-definite mass-inertia matrix M (6) given in 
(2.186) satisfies the following inequalities 

mi < m2 IICll" V^6E” (2.187) 

where mi, m2 G R are known positive constants, and H-H denotes the 
standard Euclidean norm. 

Property 2.10: Skew-Symmetry 

The time derivative of the inertia matrix and the centripetal-Coriolis 
terms satisfy the following skew-symmetric relationship 

(1m - k„) ^ = 0 ve e E" 

where M (6) denotes the time derivative of the inertia matrix. 



(2.188) 
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Property 2.11: Linearity in the Parameters 

The dynamics given in (2.186) can be linearly parameterized as follows 

Yg(t> = M{e)e + Vm{0, 6)9 + G{6) + FdO (2.189) 

where Yg{9^ 6^ 6) G denotes a regression matrix, and </) € R^ denotes 

the constant system parameter vector. 

Remcirk 2.16 The dynamic and kinematic terms for the general Euler 
Lagrange system^ denoted above by M{6), Vm{6^6), G{9), J(6), and J'^{6), 
are assumed to only depend on 6{t) as arguments of trigonometric func- 
tions, and hence, remain bounded for all possible 0(t). 



2.4.2 Control Objective 

The objective in this section is to design a control input to ensure that the 
position and orientation of S track the position and orientation of a desired 
orthogonal coordinate frame Ed where Pd{i) ^ R^ denotes the position of 
the origin of Ed relative to the origin of B and the rotation matrix from Ed 
to B is denoted by Rd{t) G SO{3). If the orientation of Ed relative to B is 
specified in terms of a desired unit quaternion g^f(t) = [qod(f) Qvdi^)]'^ ^ 
then similarly to (2.171), Rd{qd) can be calculated from qd{t) as follows 

Rd iQd) = {qld - Qvd<lvd) h + 2qvdqld + (2.190) 

As in (2.176), the time derivative of qd{t) is related to the angular velocity 
of Ed relative to B, denoted by uJd{t) € R^ with coordinates in B, through 
the following kinematic equation 



qd = B{qd)uJd. (2.191) 

The position tracking error ep{t) G R^ is defined as follows 



ep = Pd -P 



(2.192) 



where the standard assumption is made that Pd{t)^ Pd{t)j and Pd(t) are all 
bounded functions of time. To quantify the difference between E and Ed, 
we define the rotation matrix R{cq) G 50(3) from 5 to 5^ as follows 

R = RdR ~ (cq “ ^v^v) ^3 2e^e^ H- 2eoCy . (2.193) 

T 

The quaternion tracking error eq{t) = [ Co(t) e^{t) ] € given in 

(2.193) can be explicitly calculated from q{t) and qd{t) as follows [42] 



e, = 



Go 

ey 



qoqod + qvQvd 
QodQv Qoqvd 4 " q^ qvd 



(2.194) 
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by using the fact that the quaternion equivalent of (2.193) is given by the 
following quaternion product [42] 



e, == qql (2.195) 

where q’^{t) € is explicitly defined as follows 

9d(0 = [qod{t), - Qvdit)]^ ■ (2.196) 

Based on (2.169) and (2.196), it is clear that the unit quaternion tracking 
error satisfies the following constraint 

==eo + e^e„ = 1 (2.197) 

where 

0<||e^(0||<l 0<|eo(t)|<l. (2.198) 

Based on the previous definitions, the position and orientation tracking 
objectives can be stated as follows 

lim ep{t) = 0 and lim R{eq) = h, (2.199) 

respectively. The orientation tracking objective given in (2.199) can also 
be stated in the terms of the unit quaternion error of (2.194). Specifically, 
from (2.197) it can be proven that 

if lim ey{t) =0, then lim |eo(t)| = 1; (2.200) 

hence, (2.193) and (2.200) can be used to prove that 

if lim ey{t) = 0 then lim R{eq) = I 3 (2.201) 

t — too t — too 

(i.e., the orientation tracking objective given in (2.199) is achieved). 

2.4.3 Quaternion-Based Control 

Tracking Error System Development 

In this section, we develop the open-loop tracking error system that is 
utilized as the basis for the subsequent quaternion-based control design. 
To this end, the position tracking error is developed by taking the time 
derivative of (2.192) as follows 



ep=Pd- P‘ 



( 2 . 202 ) 
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After utilizing (2.176), (2.191), and (2.194) the orientation error system 
can be formulated as follows 

eo = (2.203) 

e. = (2.204) 

where Cj{t) G quantifies the difference between the angular velocity of 
E with respect to Ed (expressed in Ed) and is defined as follows 

Cj = R^{uj- ujd) . (2.205) 

To facilitate the subsequent analysis, we define a nonnegative function 
Vi{t) G R as follows 

Vi = ^epCp + {1 - Cof + e^ey. (2.206) 

After taking the time derivative of (2.206) and substituting (2.202-2.204) 
into the resulting expression for Cp(t), Co(t), and ey(t), respectively, the 
following expression is obtained 

^1 = ej {pd -p)+el (w - Wd) (2.207) 

where (2.205) was used along with Lemma A. 6 of Appendix A. Adding and 
subtracting e^K\ep and to the right-hand side of (2.207) yields 

T>1 3= -elK^ep-elK2e^ (2.208) 



Pd “H Ki€p 

— Ft^LOd + K2^v 



~h 03x3 P 
03x3 Rd . . ^ 



where K\,K 2 € R^^^ are positive-definite diagonal control gain matrices, 
and the notation 0^^x^2 used to denote a x (^2 matrix of zeros. By 
utilizing (2.180), the following expression can be obtained 



Vi = -CpKiCp - elK 2 Cy + [ej e^] AJr 
where the matrix A(^) G R^^^ is defined as 

. 0sx3 Rd . 

and the auxiliary signal r{t) G R^ is defined as 



(2.209) 



( 2 . 210 ) 



( 2 . 211 ) 
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where h(-) G may be used to control the self-motion of the system.^ 

To obtain the open-loop dynamics for r(f), we take the time derivative of 
(2.211), premultiply the resulting equation by M(0), and then substitute 
(2.186) for M{6)9{t) to obtain the following expression 



Mr = —Vmr + ¥(/) + T. 



( 2 . 212 ) 



The linear parameterization T(*)0 given in (2.212) is defined as follows 

+ {In - J+ J)/l| 



Y<p= 



£ 
dt y 



Pd^KiSp 
^d' ' ' 



—R'^UJd + K2^v 






Pd ATiCp 
—R'^LUd + K2Cy 



+ {In - J+ j)/l) 



-G{6) - Fae 

where Y{p,q,9,9,h^h,t) G denotes a measurable regression matrix, 

and (f) was defined in (2.189). 



Control Formulation 



Based on the open-loop kinematic tracking error systems given in (2.202- 
2.212) and the subsequent stability analysis, the control input is designed 
as follows 

r = -Y<t> - KrT - {Kjf 



(2.214) 



where Kr € is a positive-definite diagonal control gain matrix, and 

exact knowledge of the dynamics (including cf) given in (2.189)) and posi- 
tion/velocity measurements (i.e., p(t), q{t)^ 9(t)^ /i(t), p(t), g(t), 9(t), h{t)) 
are assumed to be available. After substituting (2.214) into (2.212), the 
closed-loop error system for r(t) can be written in the following form 



Mr = -VmT - KrV - {Ajf 



(2.215) 



Stability Analysis 

The stability of the quaternion-based tracking controller given in (2.214) 
can be examined through the following theorem. 



®The subsequent stability analysis mandates that h{t) be formulated in such a manner 
that both h{t) and h(t) are bounded signals. 
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Theorem 2.5 The control law given in (2.214) guarantees global asymp- 
totic position and orientation tracking in the sense that 

lim ep(t) = 0 (2.216) 

t-^oo 

and 

lim R{eg(t)) = h. (2.217) 

t—*oo 

Proof: To prove Theorem 2.5, we define a nonnegative function V(t) G R 
as follows 

V = ir^Mr + Vi (2.218) 

where Vi(t) was defined in (2.206). After taking the time derivative of 
(2.218) and then substituting for Vi{t) and M{6)r(t) from (2.209-2.211) 
and (2.215), respectively, the following expression is obtained 

V = (-Krr - (Ajf ) 

V [ iJ (2.219) 

-e^KiSp - elK 2 e^ + [e^ e^] KJr 

where (2.188) was used. After cancelling common terms in (2.219), the 
following expression is obtained 

V = -r'^Krr-elKiep-elK 2 e^. (2.220) 

Prom (2.218) and (2.220), it is clear that Cp(t), ey{t), and r{t) G £00 H £2 
(see Lemma A. 11 of Appendix A). Based on these facts, along with the 
assumption that Pd(t), Pd{t)^ Pdi^), h{t), and h{t) G £00 and the facts out- 
lined in Remark 2.14, standard signal chasing arguments can be used to 
prove that all of the signals (with the exception of 9{t)) remain bounded: 
the boundedness o^ 6 (t) can not be proven due to the self-motion of the sys- 
tem. Prom the above boundedness statements, we can use (2.202), (2.204), 
and (2.215) to conclude that Cp(t), ey{t), and r(t) G £ 00 , which implies 
from Lemma A. 9 of Appendix A that Cp{t), ey{t), and r{t) are uniformly 
continuous. Since Cp(^), ey{t)^ and r(t) G £00 H £2 and uniformly continu- 
ous, Barbalat’s Lemma (see Lemma A. 16 of Appendix A) can be invoked 
to prove that 

lim ep(t),ey(t), r(t) = 0 (2.221) 

t — +00 

and hence, (5.37) can be used to prove that 

U^R{eq{t)) = I 3 . 



( 2 . 222 ) 
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Remark 2.17 Due to the redundancy in the system^ we cannot prove that 
6(t) E £ 00 / therefore^ h{t) defined in (2.211) should only depend on 6{t) 
as a function of bounded trigonometric signals. In addition, h{t) cannot be 
a function of 6{t) since h(t) would be a function of 6{t), which would lead 
to an algebraic loop in the control law of (2.214). An example of h{t) that 
maximizes the robot manipulability while satisfying the above conditions is 
given by [22] 

/i=^(det(jj^)). (2.223) 



Remark 2.18 Based on the structure of the open-loop dynamics given in 
(2.212), the previous assumption of exact model knowledge can be easily re- 
laxed by designing an adaptive controller to compensate for parametric un- 
certainties. Specifically, the control input given in (2.214) can be redesigned 
as follows 



T ^ -Y^ - KrV - {Ajf 



(2.224) 



The parameter estimate vector 0(t) E W given in (2.224) is defined by the 
following gradient-based update law 



0=ry^r (2.225) 

where T E denotes a positive- definite diagonal adaptation gain ma- 

trix. Robust and sliding mode controllers could also be easily designed to 
compensate for modeling uncertainties not restricted to parametric uncer- 
tainties (e.g. see [14])- addition to relaxing the assumption of exact model 
knowledge, the assumption that velocity measurements are available can also 
be relaxed. For example, in [4I] an observer-based control scheme is used 
to achieve semi-global asymptotic position/ orientation tracking. 

2.4.4 UUV Extension 

In this section, we discuss the application of the proposed control design 
methodology to fully actuated nonredundant UUVs. Specifically, we present 
the kinematic and dynamic models for UUVs and then transform the mod- 
els into a similar form as the models given in the previous section. How- 
ever, the following clarification is necessary regarding the kinematic nota- 
tion used in this section. In the UUV (and aerospace) literature, rotation 
matrices are conventionally defined from the inertial frame to the moving 
frames [19, 23]. This convention is the opposite of the convention used in 
the previous section (and in the robotics literature) of defining rotation 
matrices from the moving coordinate frame to the inertial (base) frame. 




74 



2. Mechanical Systems 



This difference in notation will cause the UUV kinematic equations devel- 
oped in this section to be slightly different than the kinematic equations 
presented in the previous section. 



Kinematic and Dynamic Models 



The attitude kinematic equations for the UUV can be written as follows 
[19] 



’ qo ' 


_ 1 


1 

1 




“ 2 


. qoh + q^ \ 



(2.226) 



where the unit quaternion q{t) = [qo{t) Qv(^)]^ ^ describes the UUV 
attitude with coordinates in a fixed inertial orthogonal coordinate frame, 
denoted by J, and uj{t) G denotes the UUV angular velocity with co- 
ordinates in an orthogonal coordinate frame fixed to the UUV, denoted by 
U. The translational kinematic equation is given as follows [19] 



p = R^{q)vL (2.227) 

where p{t) € is the UUV position with coordinates in X, vi{t) € 
is the UUV linear velocity with coordinates in 7/, and R(q) G 50(3) is a 
rotation matrix that brings X onto U that is defined in terms of the unit 
quaternion as follows 

i? (9) = (9o -Qvgv)l3 + - 2q^ ■ (2-228) 

The dynamic model for the UUV can be written as follows [19] 

Mv “h Vrn^ "t" Di^ G — u (2.229) 

where i/(t) G R^ is composed of the linear and angular velocity vectors as 
follows 

iy=^[vl u>'^ f . (2.230) 

In the dynamic model given in (2.229), M G R^^^ denotes the constant 
positive-definite inertia matrix, Vm{^) G R^^^ denotes the skew-symmetric, 
centripetal-Coriolis matrix, D{u) G R^^^ is the diagonal positive-definite 
hydrodynamic damping matrix, G{q) G R^ is the vector of gravitational and 
buoyant forces/ torques, and u(t) G R^ represents the force/torque control 
input. The inertia and centripetal-Coriolis matrices include the added mass 
effects [19]. 
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Control Objective 

Let Ud be a desired orthogonal coordinate frame such that pd{t) G and 
qd{t) G R^ denote the desired UUV position and attitude, respectively, 
where 

qd{t)=[qod{t) qUi)Y ■ (2-231) 

Given qd{t)^ the desired rotation matrix Rd(qd) ^ 50(3) from X to Ud can 
be calculated from an equation similar in structure to (2.228). Furthermore, 
the time derivative of qd{t) is related to the desired UUV angular velocity 
Ud{t) G R^ with coordinates in Ud by an equation similar in structure to 
(2.226). The UUV position tracking error ep(t) G R^ is defined as in (2.192), 
while the attitude tracking error is represented by 

R = RRl (2.232) 

where -R(-) G 50(3) is the rotation matrix from Ud to U, The quaternion 
tracking error eq{t) = ^ t>e calculated from 

(2.228), (2.232), and the definition of Rd{qd)- The angular velocity tracking 
error cl;(t) G R^ is defined as 



uj = uj — RjOd- (2.233) 

Based on the previous definitions, the control objective is to design the 
control input u{t) to ensure UUV position and attitude tracking in the 
sense that 

lim Cpit) — 0 and lim R{eq{t)) = Is (2.234) 

t— >oo t—^oo 

or as shown in Section 2.4.2 

lim ep{t) = 0 and lim ey{t) = 0. (2.235) 

t-^oo t— >oo 



Control Development and Analysis 

The UUV kinematic error system can be developed in a similar manner as 
in Section 2.4.3 as follows 



ep=Pd- R^vl 

1 

1 ^ 

= 2 (^0^3 + e^) a;. 



(2.236) 



Based on the subsequent stability analysis, an auxiliary signal r{t) G R^ is 
defined as follows 

_ r Rpd + RKiCp 

RuJd + K2^v 



— u 



(2.237) 
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where i/{t) was defined in (2.230). To develop the open-loop error system 
for r(t), we take the time derivative of (2.237) and premultiply the resulting 
expression by the inertia matrix to obtain the following expression 



Mr — Y<j) — u 



(2.238) 



where (2.229) was utilized. The linear parametrization Y (g, e^, u, t)(j) given 
in (2.238) is defined as follows 






R {pd + Ri^p) 

"b K2^v 



"b “b Dl^ + G 



(2.239) 



where y(-) G denotes a measurable regression matrix, and (j) G R'^ 

represents a vector containing the constant coefficients from the UUV dy- 
namic model given in (2.229). Based on the structure of (2.238) and the 
subsequent stability analysis, the control input u{t) is designed as follows 



U = Y(j) + KrV -f- 



■ R 
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Sp 
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h _ 


Cy 



(2.240) 



where Kr G 



3x6 



denotes a positive-definite, diagonal gain matrix. After 
substituting the controller given in (2.240) into the open-loop error sys- 
tem dynamics given in (2.238), the following closed-loop dynamics can be 
developed for r{t) 



Mr = —Krr — 



■ R 


0 ■ 


Cp 


0 


h . 


€y 



(2.241) 



To analyze the stability of the controller given in (2.240), the same non- 
negative function given in (2.218) can be utilized where r{t) has been 
redefined as in (2.237). Specifically, after differentiating the nonnegative 
function defined in (2.218) and making the appropriate substitutions from 
(2.236) and (2.241), the following expression can be obtained 

V = -ej {R'^vl - Pd) - el (uj- RxJd^ 



—r^ ( Kpr + 






R 0 

0 h 

R'^ 0 

0 h 



Rpd - VL 
Rujd - u; 



(2.242) 



^ I Krr + 



R 0 

0 h 
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where (2.233), Lemma A . 6 of Appendix A, and the fact that HT {q) R {q) = 
Is were used. After adding and subtracting the error terms e^{t)Kiep{t) 
and e^{t)K 2 ev{t) to (2.242), utilizing (2.237), and then cancelling common 
terms, the following expression can be obtained 

V = -e'^Kiep-elK2ey-r^Krr. (2.243) 

Prom (2.218) and (2.243), it is clear that Cp(t), e„(t), and r(t) € Coo<^^2 
(see Lemma A. 11 of Appendix A). Standard signal chasing arguments can 
be utilized to prove that all of the signals remain bounded and that Cp(t), 
ey(t), and r(t) are uniformly continuous. Since Cp(t), ey{t), and r(t) G 
Coo n C 2 and are uniformly continuous, Barbalat’s Lemma (see Lemma 
A. 16 of Appendix A) can be invoked to prove that 

lim ep(t),ey(t),r(t) = 0 (2.244) 

t—*oo 

and hence, (5.37) can be used to prove that 

lim R{eg{t)) = h. (2.245) 

t—^OO 

Remark 2.19 An adaptive controller could he designed as described in Re- 
mark 2.18 for the case where 0 is uncertain. Moreover ^ an output feedback 
controller could also be designed according to the framework presented in 
[4-1] that produces semi-global asymptotic position/ attitude tracking. 

2.4.5 Simulation Results 

The model-based full-state feedback controller of (2.240) and the adaptive 
full-state feedback controller (see Remark 2.19) were simulated based on 
the dynamic model given in [33] as follows 

M = diag (mi, m 2 , m 3 , ??i 4 , 7715 , me) 

D{u) ^ diag(dii -f- di 2 \v\ \ ,^21 + ^22 \i ^2 \ ,dsi + 0^32 , 

G?41 + ^42 \u/\ 4- ds2 l^sl 5 0?61 + ^62 I^^gI) 

0 0 0 0 rnsvs —m2V2 

0 0 0 —TTisVs 0 ruivi 

0 0 0 m2?^2 —miui 0 

0 rusv's —m2i^2 0 — rasa's 

—msi'3 0 miui —itiqUq 0 m4U4 

m2i'2 —miUi 0 m5Z/5 —m4V4 0 




(2.246) 
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where I'i denotes the element of the velocity vector iy. The UUV is 
assumed to be neutrally buoyant with the origin of the U frame located 
at the center of gravity; thus, G{q) = 0. The following numerical values 
of the mass, inertia, and damping parameters in (2.246) were used in the 
simulation 



mi = 215 [kg] 
m 2 = 265 [kg] 
m 3 = 265 [kg] 

7714 = 40 [kg • m^] 
ms = 80 [kg • m^j 
me = 80 [kg • m^] 



dll = 70 [Nm • sec] 
di2 = 100 [N • sec2 ] 
d 2 i = 100 [Nm • sec 
d22 - 200 [N-sec2] 
dai = 200 [N-sec2] 

ds 2 = 50 [N • sec^ ] 



^41 = 30 [Nm • sec] 

0^42 = 50 [N • sec^] 

d^i = 50 [Nm. sec] 

ds 2 - 100 [N • sec2] (2.247) 

dei = 50 [Nm • sec] 

de2 = 100 [N • sec^]. 



Prom (2.246), the parameter vector (j) in (2.239) can be constructed as 
follows 



(j) — [ mi m2 m3 m4 ms me 
d22 <^31 ds2 d4i d42 d^i 



dll di2 d.21 
dh2 d^i dQ2 



(2.248) 




FIGURE 2.16. Position and attitude tracking errors for the model-based full-state 
feedback UUV controller. 

For each controller, the initial attitude of the vehicle was selected as 
follows 

q{0) = [ 0.9486, 0.1826, 0.1826, 0.1826 f 



(2.249) 
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FIGURE 2.17. Angular velocity tracking error for the model-based full-state feed- 
back UUV controller. 
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FIGURE 2.18. Force and torque control inputs for the model-based full-state 
feedback UUV controller. 
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FIGURE 2.19. Position and attitude tracking errors for the adaptive full-state 
feedback UUV controller. 
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FIGURE 2.20. Angular velocity tracking errors for the adaptive full-state feed- 
back UUV controller. 
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FIGURE 2.21. Force and torque control inputs for the adaptive full-state feedback 
UUV controller. 
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FIGURE 2.22. Selected parameter estimates for the adaptive full-state feedback 
UUV controller. 




82 



2. Mechanical Systems 



and the desired position trajectory was selected as 

pd{t) = 



sin(0.1t)(l-e-° O“ ) 
sin(0.1i)(l - 
sm{0.1t){l - 



m . 



(2.250) 



Moreover, the desired attitude trajectory was generated using the following 
differential equation 



1 



™ 2[g„,(t)/3 + CW J 



UJd{t) 



where the initial condition was selected as follows 
9d(0)=[l, 0, 0, 0]^. 

The desired angular velocity selected as 



(2.251) 



(2.252) 



Ud{t) = 



[rad/sec]. 



0.1 cos(0.1t)(l - e-° °“") + O.OSt^ sin(0.1t)e-o °i*' 

0.1 cos(0.1t)(l — + 0.03t^ sin(0.1t)e“°‘’^*^ 

0.1 cos(0.1t)(l — + 0.03t^ sin(0.1t)e“°°^‘^ 

(2.253) 

For the model-based full-state feedback controller, the following control 
gains were used 



= diag (1,1,1) /f 2 = diag (1,1,1) 



(2.254) 



Kr- = diag (25, 25, 25, 25, 25, 25) . 

Figures 2.16-2.18 illustrate the position and attitude tracking errors, an- 
gular velocity tracking errors, and the exact model knowledge full-state 
feedback control input, respectively. For the adaptive full-state feedback 
controller, the following control and adaptation gains were utilized 

Ki = diag (30, 30, 30) = diag (4, 4, 4) 

Kr = diag (30, 30, 30, 30, 30, 30) 



(2.255) 



F = diag (10, 100, 100, 10, 10, 10, 300, 300, 300, 300, 300, 300, 
10,10,10,10,100,100) 

where the parameter estimates were initialized as follows 



(/.i(0) = 10 Vi = 1,2, ...18. 



(2.256) 
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Figures 2.19-2.21 show the position and attitude tracking errors, angu- 
lar velocity tracking errors, and control inputs of the adaptive full-state 
feedback controller, respectively. Figure 2.22 illustrates selected parameter 
estimates. 



2.5 Background and Further Reading 

Motivated by the desire to suppress vibrational effects and due to the prob- 
lems associated with passive damping, the design of active controllers for 
balancing high-speed rotational structures has been investigated. For ex- 
ample, in [30] , Lum, Coppola, and Bernstein presented a new approach re- 
ferred to as adaptive autocentering to stabilize the motion of the center of 
mass by attenuating the transmitted forces under varying rotational speed. 
This approach differs from autobalancing in that the autobalancing con- 
trol objective is to stabilize the geometric center. The aforementioned work 
based on force attenuation was then expanded in [31] to facilitate imbalance 
cancellation. In [28], Long, Carroll, and Mukundan designed an adaptive 
controller for a single axis, constant speed rotor, active magnetic bearing 
system using integrator backstopping techniques to deal with a combina- 
tion of an unknown static load change and an unbalanced sinusoidal load 
disturbance. In [47], a nonlinear controller was proposed to damp out vi- 
bration for a two-dimensional rotating flexible body-beam model with an 
unbalanced load attached to its free end. More recently, in [13] a DCAL- 
based adaptive autobalancing controller is designed to achieve a global 
exponential result under a persistency of excitation condition. 

Motivated by various potential industrial applications, several researchers 
have investigated automatic control systems for dynamically positioned 
ships. These control systems are most commonly designed after linearizing 
the system dynamic equation about a set of prespecified yaw angles [20]. 
This procedure enables the application of linear control methods along with 
gain scheduling techniques. For example, early ship control systems used 
commercial PID controllers in cascade with a low-pass filter [4]. Later, lin- 
ear optimal control laws in conjunction with Kalman filtering techniques 
were proposed in [21, 39]. With the goal of overcoming the linearization 
procedure, several control algorithms that take the nonlinear ship dynam- 
ics into account have also been proposed in [9, 18, 34]. In [18], a class 
of nonlinear PD-type control laws for position regulation was developed; 
however, robustness against parametric uncertainties could not be guar- 
anteed. A robust nonlinear control law using singular perturbation theory 
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was presented in [9] that accounts for parametric uncertainties and external 
disturbances, and a sliding-mode control approach was presented in [34]. 

Since most commercially available marine vessels only contain position 
sensors, control schemes that do not require direct velocity measurements 
are highly desirable (i.e., output feedback controllers as opposed to full- 
state feedback controllers). Motivated by this fact, [20] presented the design 
of a nonlinear output feedback controller using an observer backstepping 
method. Specifically, a nonlinear model-based observer-controller was used 
to eliminate the need for velocity measurements while achieving global ex- 
ponential position tracking. More recently in [29] , a globally asymptotically 
stabilizing controller for ship regulation was developed that only used po- 
sition measurements. However, similar to [20], the observer-controller of 
[29] required exact knowledge of the nonlinear ship dynamics. Recently, 
the authors of [1] presented a global output tracking controller for a class 
of Euler-Lagrange systems that is directly applicable to the dynamically 
positioned surface vessel problem; however, the controller requires that the 
system parameters be known. The result in [1] was extended in [2] by impos- 
ing a monotone damping condition on the nonlinearities of the unmeasured 
states to remove the condition that the nonlinearities be globally Lipschitz. 
More recently, a global adaptive output feedback tracking controller for dy- 
namically positioned ships was designed in [17]. 

Some past work that deals with task space control formulation can be 
found in [6, 24, 42]. Specifically, one of the first results in task space control 
of robot manipulators was presented in [24]. Resolved-rate and resolved- 
acceleration task space controllers using the quaternion parameterization 
were proposed in [42] . An experimental assessment of different end-effector 
orientation parameterizations for task space robot control was provided in 

[6] . Recently in [8], a stability proof using a strict Lyapunov function was 
presented for a quaternion- based resolved-acceleration controller. Exam- 
ples of quaternion-based task space controllers that do not require velocity 
measurements are given in [7, 41]. Specifically, the controller proposed in 

[7] yields a local stability result, whereas the result given in [41], achieves 
a semi-global stability result. For additional work related to controllers for 
redundant robots, see [10, 22, 24, 35, 37, 43, 45] and the references therein. 
The mechanical system models and the control development in this chap- 
ter are based on ordinary differential equations (ODEs). Some mechanical 
systems such as flexible structures are modeled by partial differential equa- 
tions (PDFs) and the corresponding control designs will vary from the 
approaches demonstrated in this chapter. For a treatment of mechanical 
systems that are modeled by ODEs and PDFs, see [15]. 
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3 

Electric Machines 



3.1 Introduction 

In this chapter, model-based control designs are developed for electric ma- 
chines that are typically described by (i) electrical subsystem dynamics 
that include all of the relevant electrical effects, (ii) an algebraic torque 
coupling that represents the electrical to mechanical energy conversion, 
and (hi) mechanical subsystem dynamics that may include the rotor and 
position dependent load dynamics. A block diagram that illustrates the 
interconnection of these coupled nonlinear dynamics is given in Figure 3.1. 

Since the electrical subsystem dynamics have a faster time constant than 




Typically Neglected Simplified System 

Electrical Dynamics 



FIGURE 3.1. Block diagram for electric machines, 
the associated mechanical dynamics, the electrical dynamics are often ne- 
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glected, especially for many industrial speed applications that are not re- 
quired to be high-precision. For example, induction motors are widely used 
in industrial speed control applications because of their simple design and 
ruggedness. The popular field-oriented control (FOC) strategy controls the 
induction motor by decoupling the current control inputs that appear bilin- 
ear ly in the mechanical subsystem dynamics. Specifically, the FOC strategy 
is based on a rotational transformation that allows the system dynamics to 
be expressed in a frame that aligns with the direction of the rotating mag- 
netic field vector in the air gap of the motor. This transformation breaks 
up the bilinear structure of the electromagnetic torque generation, and new 
control inputs (in the transformed frame) can be designed independently to 
provide speed tracking control as well as the establishment of a desired ro- 
tor fiux magnitude. Based on the standard FOC strategy, researchers have 
demonstrated several benefits of an indirect field-oriented control (IFOC) 
strategy where the system is transformed to a frame that aligns with the 
desired rotor fiux vector as opposed to aligning with the actual rotor fiux 
vector in the standard FOC approach. In the first section of this chapter, 
a brief review of the FOC and IFOC schemes is provided. A limitation of 
the IFOC strategy is that it is constructed based on the standard FOC 
legacy and does not integrate well with nonlinear analysis techniques. To 
overcome this barrier an improved IFOC strategy is developed that is con- 
structed via Lyapunov-based design and analysis techniques. Specifically, 
the thrust will be to present simple alterations to the popular IFOC method 
in a systematic manner. The modifications to the IFOC scheme involve the 
injection of additional nonlinear terms into the current control input and 
the so-called desired rotor flux angle dynamics. These additional nonlinear 
terms facilitate an exponential stability result via the direct cancellation of 
mechanical/electrical subsystem coupling terms during the Lyapunov sta- 
bility argument. Furthermore, Lyapunov-based design and analysis tools 
facilitate the design of adaptive controllers that compensate for the para- 
metric uncertainty associated with the mechanical load. 

For some positioning applications, high-precision electric machines are 
required. An electric machine that is typically used in high-precision appli- 
cations is the switched reluctance motor (SRM). The SRM can be consid- 
ered to be an AC machine with an iron core rotor. Similar to the induction 
motor, there are no mechanical brushes that require expensive maintenance 
as required for permanent magnet brushed DC motors. In addition to the 
reduction in maintenance, there are several advantages to using SRMs as 
actuators in high-performance motion control applications. These advan- 
tages include (i) low cost and high reliability through simple design and 
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construction, (ii) increased capability to withstand high temperature en- 
vironments, (iii) significant reduction in friction, and (iv) the ability to 
increase torque production through electromagnetic gearing. Since SRMs 
are typically used in high-precision applications, control designs for these 
machines incorporate the electrical dynamics. Moreover, SRMs are often 
used in applications that demand high torque (i.e., high current), requiring 
the motor to operate “high” on the saturation curve. Hence, many mo- 
tor control experts also believe that saturation effects must be included in 
the SRM model to develop high-precision controllers. Typical approaches, 
which rely on feedback linearization techniques, exhibit control singularities 
when the stator current goes to zero. While it has been suggested that the 
singularity issue is a minor nuisance, the presence of singularities indicates 
that improvements in the control structure can still be accomplished. In 
pursuit of the aforementioned objectives, the second section of this chapter 
uses a general nonlinear model of the SRM to develop an adaptive controller 
for the full-order electromechanical model. Specifically, the developed SRM 
controller (i) is based on the full-order model (i.e., the electrical dynamics 
are not neglected), (ii) compensates for uncertainty in electromechanical 
model, (iii) utilizes a fiux linkage model that includes magnetic saturation 
effects, and (iv) eliminates all control singularities (i.e., the voltage control 
input remains bounded for all operating conditions). The design assumes 
that a commutation strategy^ can be developed to ensure the desired mag- 
netic forces are delivered to the system. As an extension, a commutation 
design is presented to satisfy the assumed conditions required for the sta- 
bility analysis. 

Vibrational effects induced on a motor rotor (or long transmission links) 
can have a significant impact on many high-performance applications. Con- 
ventional bearings can be used to damp out these vibrations; however, fric- 
tional effects can result in negative system performance. Since magnetic 
bearings allow contact- free levitation, they exhibit several advantages over 
conventional bearings. For example, since magnetic bearings do not require 
lubrication, they can easily operate under environmental constraints that 
prevent the use of lubrication [29]. While allowing high circumferential 
speeds at high loads, magnetic bearings do not suffer frictional wear and 
tear; therefore, they offer a virtually unlimited lifetime with little or no 
maintenance. The term active magnetic bearing (AMB) is used to denote 
a set of electromagnets serving as a magnetic bearing by producing desired 



^The term commutation strategy is often used to describe a step in the control design 
procedure that involves utilizing the desired torque trajectory and the structure of the 
torque transmission model to construct the desired current trajectory signals. 
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magnetic forces through an active controller. Through an AMB, magnetic 
forces can be developed to (i) eliminate vibration through active damping, 
(ii) adjust the stiffness of the suspended load, (iii) provide an automatic 
balancing capability, or (iv) deliberately excite vibrations [30]. Because of 
these advantages, AMBs are used in an increasing number of commercial 
high-performance applications in the domain of rotating machinery. These 
applications include ultra-high vacuum pumps, canned pipeline compres- 
sors and expanders, high-speed milling and grinding spindles, flywheels for 
energy storage, gyroscopes for space navigation, and spinning spindles. In 
a typical AMB application, the magnetic forces, which are applied by sets 
of stator electromagnets, must be adjusted online to ensure that the rotor 
is accurately positioned. Unfortunately, the ascendancy of AMBs over tra- 
ditional bearings has been stymied because the control problem is compli- 
cated by the inherent nonlinearities associated with the electromechanical 
dynamics. In the third section of this chapter, the nonlinear model of a six 
degree of freedom (DOF) active magnetic bearing system is developed. The 
AMB model can be represented by the same block diagram as depicted in 
Figure 3.1. Based on this model, the AMB control problem is stated and 
a nonlinear tracking controller is developed. In a similar manner as for the 
SRM, a commutation design is presented as an extension to satisfy the 
assumed conditions required for the stability analysis. 



3.2 Induction Motor 

As stated previously, many industrial manufacturers have opted to use the 
induction motor as the desired actuator for many constant speed drive 
applications because of the its relative inexpensive cost, rugged construc- 
tion, and inherent operating reliability. However, many of the previously 
designed velocity setpoint control methodologies may prove to be woefully 
inadequate for high-performance rotor velocity tracking applications using 
the induction motor. In an effort to use the induction motor for demand- 
ing tracking applications while still benefit ting from its desirable features, 
nonlinear control strategies have been developed to overcome the numerous 
difficulties associated with the induction motor’s complex coupled high- 
order electrical dynamics. Due to its extensive industrial use, the IFOC 
algorithm is one of the more popular strategies employed for current-fed 
induction motor control applications. In this section, a modified version 
of the standard IFOC is derived to achieve global exponential rotor veloc- 
ity/rotor flux tracking. An extension is also provided that proves how a 
simple modification to the controller can yield global asymptotic tracking 
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despite the parametric uncertainty associated with the mechanical dynam- 
ics and load. 



3.2.1 System Model 

Based on the common assumptions of equal mutual inductances and a linear 
magnetic circuit, the electromechanical model of a current-fed induction 
motor driving a mechanical subsystem in the rotating rotor reference frame 
can be written as follows [22] 

Jm^ + Buj -j- = (XiU^ Jip (^-1) 






(3.2) 



where uj{t) E M represent the rotor velocity and acceleration, respec- 
tively, and '0(t) = [ V ^ denotes the rotor flux. In the 

electromechanical model given in (3.1) and (3.2), the coefficients J^, B, 
Tl{^) ^ ^ denote the system inertia (including rotor inertia), the coeffi- 
cient of viscous friction, and a known nonlinear load that is assumed to be 
bounded if uj{t) is bounded, respectively, J E denotes the following 

skew-symmetric matrix 



0 - 1 ] 



1 0 



(3.3) 



and u(t) = [ Ua(t) Ub{t) E R^ denotes the stator current control input. 
The positive constants ai, /?i, /?2 ^ R given in (3.1) and (3.2) are related 
to electrical circuit parameters as follows 



ipM 








(3.4) 



where L^, M E R denote the per-phase rotor self-inductance and mutual 
inductance, respectively, ^ R denotes the rotor resistance, and rip E R 
is the number of motor pole pairs. 



Remark 3.1 The electromagnetic torque transmission term a\u^ {t)J 'll) {t) 
of (3.1) is bilinear (i.e., the system state vector 'll) (t) multiplies the control 
input vector u(t)). The presence of this bilinear term presents a design 
challenge because it couples the control inputs. Hence, to design the control 
inputs Ua {t) and ut, (t) independently, a control strategy must target the 
bilinear structure of (3.1). The desire to decouple the control inputs has 
motivated the development of previous FOC and IFOC strategies. 
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3.2.2 Control Objective 

The primary objective in this section is to develop a controller for the 
current-fed induction motor that ensures rotor velocity tracking under the 
constraint that rotor velocity is the only measurable signal. To this end, a 
standard IFOC rotor velocity regulation controller is first presented. Based 
on the structure of the standard IFOC design, an improved IFOC rotor 
velocity tracking controller is designed. The improved IFOC design is also 
redeveloped with a structure that facilitates Lyapunov-based analysis tech- 
niques. To quantify the objective of these controllers, a rotor velocity track- 
ing error, denoted by e{t) G M, is defined as follows 

e — LUd- oj (3.5) 

where ujd{t) G R represents the desired rotor velocity trajectory (for the 
standard IFOC regulation controller, ujd is defined as a constant). The sub- 
sequent development is based on the typical assumption that the desired 
rotor trajectory is selected so that ujd(i), ^^d(^) ^ To provide flexibility 
in the design of feedback control laws for the mechanical subsystem dy- 
namics given by (3.1), a filtered tracking error signal, denoted by r{t) G R, 
is defined as follows [23] 

r = e + C~^ I 5 ^^ ^(^)| (^-®) 

where {•} denotes the inverse Laplace Transform operation, s denotes 
the Laplace Transform variable, and Kjr{s) G R denotes a linear filter 
selected to ensure that the following transfer function is proper and expo- 
nentially stable [19] 

e(s) _ s 
r{s) s + Kf{s)' 

Motivation for the definition of the filtered tracking signal introduced in 

(3.6) is given by the fact that the subsequent control development and 
stability proof can be accommodated without restricting the feedback con- 
trol structure. For example, by redefining the linear filter Kf(s) given in 

(3.6) , the control structure can be changed from proportional feedback to 
proportional-integral (PI) feedback without restructuring the controller and 
requiring additional stability analysis. Specifically, a proportional feedback 
controller can be obtained by defining the linear filter as follows 



3.7) 



Kf{s) = 0 => ksr{t) = kse{t) 



(3.8) 
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where kg G R is a constant control gain. To change from proportional 
feedback to PI feedback, the linear filter can be redefined as follows 



Kf{s) = ki kgr{t) = kge{t) 4- kgh / e(r) dr 

Jo 



(3.9) 



where /cj G R is a constant control gain. Given that the transfer function 
defined in (3.7) is proper and exponentially stable, Lemmas A. 14 and A. 15 
of Appendix A can be invoked to prove that if r{t) is exponentially (or 
asymptotically) driven to zero, then e{t) will be exponentially (or asymp- 
totically) driven to zero. 

In addition to the rotor velocity tracking control objective, a secondary 
control objective is to force the magnitude of the rotor flux to track a desired 
trajectory (or a constant setpoint for the standard IFOC controller). To 
quantify this secondary objective, the rotor flux magnitude tracking error, 
denoted by G R, is defined as follows 



Vs = Sl-Uf 



(3.10) 



where H-H denotes the standard Euclidean norm, and 6d(t) G R denotes 
the desired magnitude of the rotor flux (for the standard IFOC regulation 
controller, 6d is defined as a constant). The desired rotor flux magnitude is 
assumed to be selected so that 6d (t)^ ^d{^) ^ ^005 ^nd that 6d {t) is selected 
as a strictly positive function in order to prevent a potential singularity in 
the subsequent control development. 



3.2.3 Standard IFOC Control 

The electromechanical model for the induction motor given in (3.1) and 
(3.2) is expressed in terms of a rotating rotor reference frame. The moti- 
vation for an IFOC scheme is to transform the electromechanical model 
from the rotating rotor reference frame to a frame that is aligned with the 
direction of the desired rotor flux vector. That is, IFOC is aimed at trans- 
forming the dynamics from a Cartesian coordinate system representation 
to a polar coordinate system representation. By performing this transfor- 
mation, the bilinearity in the torque transmission relationship of (3.1) can 
be eliminated, and hence, the design of the two stator current control in- 
puts can be decoupled. Specifically, to transform the IFOC stator current 
input vector to the stator current input vector expressed in the rotating 
rotor reference frame, the following transformation can be applied 



u = 



cos Pd -sinpd 
sin Pd cosp^ 



(3.11) 
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where Ufoc {t) — [ Ufoci (i) u/oc2 (0 ] ^ is the standard stator cur- 

rent IFOC input expressed in the field-oriented reference frame as follows 



'^foc 



02 



Sd 



Td 

ai6d 



iT 



(3.12) 



where ai, /?2 are defined in (3.4). For the control input given in (3.11), 
Pd(t) ^ ^ denotes the desired rotor fiux angle whose dynamics are governed 
by the following differential equation and initial condition 

Pd (0) = 0 (3.13) 

ai6i 

where Td{t) € K denotes the following desired torque signal for the me- 
chanical subsystem 

Td = y + ksr. (3.14) 

In (3.14), the auxiliary signal y(co, e) G M denotes a feedforward signal that 
is defined as follows 



y{cj, e) = (£-1 {Kf (s) e(s)}) +Bu + Tl (w) (3.15) 

and /C 5 G M denotes a positive constant control gain. Roughly speaking, 
^/oci (t) (the so-called direct-axis current) is designed to force the rotor 
fiux magnitude to converge to 6d, while u/oc 2 (0 so-called quadrature- 
axis current) is designed to force the rotor angular velocity to converge 
to Ud. As stated previously, the standard IFOC scheme targets the rotor 
velocity regulation problem, and hence, assumes that 6d and cud are selected 
as constants. The IFOC design given in (3.11-3.15) can be proven to yield 
global asymptotic rotor velocity regulation (see [34]). 



3.2.4 Improved IFOC Control 

IFOC-Based Control 

In this section, modifications to the previous IFOC design are provided as a 
means to achieve improved performance (e.g., faster transient response and 
improved robustness). That is, the improved IFOC strategy developed in 
this section fosters global exponential^ rotor velocity tracking rather than 



^ With the achievement of exponential rotor velocity tracking as will be seen in (3.41), 
a certain degree of robustness is acquired for the improved IFOC strategy. That is, expo- 
nentially stable systems inherently have the ability to tolerate a greater degree of uncer- 
tainty in the form of unknown parameters, external disturbances, unmodeled dynamics, 
etc., as compared to asymptotically stable systems. For a more detailed discussion on 
the theorems and analysis concerning the robustness of exponentially stable systems, see 
[37] and the references therein. 
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the asymptotic regulation results associated with standard IFOC designs. 
Specifically, to develop the improved IFOC strategy, the controller given in 
(3.12) is modified as follows 



'^foc 



. 02 



Sd ^ — h Ho 

P2 




(3.16) 



where the auxiliary signal ^ 0 (^ 5 ^ ^ is injected to sever the electri- 
cal/mechanical subsystem interconnections and is explicitly given as 



In addition to the modification of (3.12), the differential equation given in 
(3.13) is also modified as follows 



Pd 






Pd(0)=0 



where the auxiliary signal Oi(r, t) G R is defined as 



01 I 1 

02 02^d Sd 



and the auxiliary signal 7/(0;, e, t) G R is redefined as follows 
y{uj, e, t) = Jm {Cod + [Kp (s) e(s)}) + Sw + Tl (w) . 



(3.18) 



(3.19) 



(3.20) 



Lyapunov-Based Control 



The development of the control structure of the improved IFOC design 
given in (3.11), (3.14), and (3.16-3.20) is based on the legacy of the stan- 
dard IFOC control structures. Unfortunately, the standard IFOC structure 
does not readily accommodate Lyapunov-based analysis techniques. In this 
section, the improved IFOC design is written in a structure that is more 
conducive to a Lyapunov-based analysis. To this end, a desired rotor flux 
trajectory signal, denoted by 'ipdi'^^) — [ '0da(^) '^db{^) ^ R^, is defined 

as follows [32] 



'^d = ^d 



COSPd 

sin Pd 



(3.21) 



The dynamic response of '0^(0 ^^n be determined by taking the time deriv- 
ative of (3.21) as follows 



= I («. 



cos Pd 

sin Pd 



+ PdJ 



^d 



sin Pd \j 



(3.22) 
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where (3.3) has been utilized. After using the definition for (3.21) and then 
substituting (3.18) into the resulting expression for p^(t), the dynamics for 
'0^(^) can be rewritten in the following form 

~ OiirQi^ J'lp^ (3.23) 

where J was defined in (3.3). After substituting (3.16) into (3.11) for Ufoc(t) 
the following expression can be obtained 



u = 




cospd 1\ 

sinpd \J 



-f 



/?2 ^d02 ^d 



cospd 

sinpd 



(3.24) 



where (3.3) was used. The commutation strategy given in (3.24) can also 
be written in the following compact form 



u = 



Td 






after utilizing (3.19) and (3.21). 



(3.25) 



Remark 3.2 Based on the structure of (3.21), the following relationship 
can he determined 



liv'd (011^ [ cos sin Pd 



cospd 

sinpd 






(3.26) 



Given (3.26), the rotor flux magnitude tracking error introduced in (3.10) 
can he written as follows 

Vs = liv’d (Of - IIV’(0ll^ = (V’d + V’)^^v- (^-27) 

where the rotor flux tracking error, denoted by = [ rj,j,,^{t) V^bi^) 1^ ^ 

is defined as follows 

V^=i’d~ 0- (3.28) 

From (3.27), it can he shown that if g^{t) is exponentially stable and if 
hath 'ipit) G CoQ, then r}^{t) will he exponentially stable. Hence, the 

secondary control objective of (3.10) will he achieved. This fact will be ex- 
ploited in the subsequent closed-loop development and stability analysis. 
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Closed-Loop Error System 

To construct the closed-loop rotor flux tracking error system, we take the 
time derivative of (3.28) and substitute (3.2) into the resulting expression 
as follows 

*7,/, = - /^2^- (3-29) 

After substituting (3.23) and (3.25) into (3.29) for i/’^(t) and u(t), respec- 
lively, the following closed-loop dynamics for fj^ (t) can be obtained 



Vi, - ^V’d + Ji’d + /?i (v-d - V^) 



(3.30) 






Pi Sd TdT \ 

P2 P2Sd ^ PA ) J 



where (3.19) and (3.28) have been utilized. After cancelling common terms 
in (3.30) and noting that JJ = -I 2 (where I 2 denotes the 2 x 2 identity 
matrix), the closed-loop rotor flux tracking error system can be rewritten 
in the following form 



Vi, = -PiVi, + ocirJ 



Td 



Jipd + f^iV'd 



(3.31) 



After utilizing (3.25), (3.31) can be written as follows 



Vi, = -PiVi, + airJu. (3.32) 

To formulate the closed-loop tracking error system for the mechanical 
subsystem, we take the time derivative of the rotor velocity tracking error 
given in (3.6), premultiply the resulting expression by J^, and use (3.1) to 
obtain the following expression 

Jm^ = y — H- a\u^ — a\vF J'ljp (3.33) 



where y{cu^e,t) was defined in (3.20), and the product aiu^{t)J'ip^{t) has 
been added and subtracted to (3.33). By substituting (3.25) into (3.33) for 
only the first occurrence of u{t)y the following expression can be obtained 

Jmr- 2/ - Td + (^Td - (^^) ^d'^^^V’d + ^iV'd^V’d 
-\-aiu^ — aiu^Jip 




where Td{t) has been added and subtracted to (3.34). By exploiting the 
facts that J^J = I 2 and ^J(0-^^d(0 " 0, the closed-loop dynamics for 
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the rotor velocity tracking error can be obtained as follows 

Jmr = -ksr + aiu^Jri^ (3.35) 

where (3.14), (3.26), and (3.28) have been utilized. 



Stability Analysis 

Given the improved IFOC controller of (3.11), (3.14), and (3.16-3.20), the 
following theorem can be used to prove that the rotor velocity /flux magni- 
tude tracking errors for the current-fed induction motor are confined to an 
exponentially decaying envelope. 



Theorem 3.1 The improved IFOC structure of (3.11), (3.14), (ind (3.16- 
3.20) ensures global exponential rotor velocity /rotor flux tracking in the 
sense that 



\z{t)\\ < /^||2:(0)||exp 



(3.36) 



-iT 



For the exponential envelope given in (3.36), z(t) = r{t) v/^it) 
where r(t) and are defined in (3.6) and (3.28), respectively, and the 

coefficients X\, X 2 , A3 G R are positive constants defined as follows 



Ai = - min { J^, 1} , A2 = - max { J^, 1} , 
and A3 = min {ks,Pi} . 



(3.37) 



Proof: To prove Theorem 3.1, we define the nonnegative function V{f) G 
R as follows 

y = /mr'^ + (3.38) 

Based on the structure of (3.38), the following inequalities can be formu- 
lated 

Ai ||2||^ < V" < Aall^f (3.39) 

where z{t) was introduced in (3.36), and Ai and A2 were defined in (3.37). 
After taking the time derivative of (3.38) and utilizing (3.32) and (3.35), 
the following expression can be obtained 

V = -k^r^ - /?! + a^r + rj^Ju) . (3.40) 

After using the fact that = —J, (3.40) can be upper bounded as follows 

1A<-A3||2 



(3.41) 
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where A3 was defined in (3.37). To prove the exponential tracking result 
given in (3.36), the inequalities given in (3.39) can be used to rewrite (3.41) 
as follows 

V <-^V. (3.42) 

A2 

After solving the differential equation given in (3.42) according to Lemma 
A. 10 of Appendix A and then utilizing (3.39), the result given in (3.36) can 
be obtained; hence, r(t) and are also contained in the exponential 

envelope given in (3.36). 

Since G Coo^ (3.28) can be used to prove that ip(t) G £oo- From 

the restrictions placed on H(s) defined in (3.7) and the fact that r(t) is 
bounded by the exponential envelope given in (3.36), Lemma A. 14 of Ap- 
pendix A can be used to prove that e{t) is also confined to an exponentially 
decaying envelope. Specifically, for the PI compensator (i.e., Kf(s) = ki), 
the following exponential envelope for e (t) can be obtained 



e{t)\ < 



ki |e(0)| exp(-A:i^) + 



■Ik(0)||exp 




+ 



A2 2 fc,A 2 |N( 0 )|| / f_ 2 ^. 

Ai (2A2/ci - A3) y ^ V 2A2 



exp {—kit) 



(3.43) 



After using (3.26-3.28), and the fact that 7]^{t) is contained in the exponen- 
tially decaying envelope given in (3.36), the following exponential envelope 
can be developed for the rotor flux magnitude 



\Vs\ < 

V ^1 



0(0)11 exp 



A3 

'2A2’ 



t + 



h||.(o)||^ 



exp 



A2 



(3.44) 



□ 



3.2.5 Adaptive Extension 

To obtain the result given in (3.36), exact model knowledge of the me- 
chanical subsystem was assumed. In practice, the constant parameters of 
the mechanical subsystem may not be exactly known (i.e., the parameters 
Jm^ and the constant coefficients of the load function Tl(u) may be 
unknown). In this extension, an adaptive update law is developed that can 
be incorporated with the previous improved IFOC design to compensate 
for parametric uncertainty in the mechanical subsystem. To this end, the 
function 7/(0;, e, t) defined in (3.20) is assumed to satisfy the following linear 
parameterization property 



y = Y6 



(3.45) 
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where Y{(j^e,t) G is a known regression vector, and 9 £W denotes 
the unknown constant parameter vector. To compensate for the parametric 
uncertainty contained in the unknown vector 0, the desired torque signal 
of (3.14) is redesigned as follows 

rd = Y6 + ksr (3.46) 

where 6(t) G denotes a parameter estimate vector that is calculated 
on-hne via the following adaptive gradient update law 



e= TY'^r (3.47) 

where F G R^^^ is a constant positive diagonal adaptation gain matrix. 

Because (3.14) is redesigned as in (3.46) due to parametric uncertainty, 
the closed-loop error system for r{t) must be modified. Specifically, after 
substituting the new expression for Td{t) given in (3.46) into (3.34) and 
exploiting the facts that J = I 2 and 'ip'dJ'^d — O 2 , the closed-loop dy- 
namics for the rotor velocity tracking error given in (3.35) are now given 
by the following expression 

JmT = -ksT YYO aiu^Jr]^ (3.48) 

where (3.26) and (3.28) have been used. The parameter estimation error 
9{t) G R^ introduced in (3.48) is defined as follows 

9 = 6-9. (3.49) 

The following theorem can now be used to examine the stability of the 
adaptive extension of the improved IFOC design. 

Theorem 3.2 The adaptive improved IFOC structure of (3.11), (3.16- 
3.29), and (3.46) ensures global asymptotic rotor velocity /rotor flux track- 
ing in the sense that 

lim e{t), T]^{t) = 0. (3.50) 

t — >00 

Proof: To prove Theorem 3.2, we define the nonnegative function V(t) G 
R as follows 

V=^Jmr^ + lvl^V^+o''r-^0. (3.51) 

After taking the. time derivative of (3.51) and utilizing (3.32), (3.35), and 
(3.47), the following expression is obtained 

V =z -k^r^ +rY0 - 

+Qir + 77J Ju) - O^Y'^r. 



(3.52) 
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After cancelling common terms and using the fact that = — J, (3.52) 
can be expressed as follows 

V = -ksT^ - . (3.53) 

Since V (t) is a nonnegative function, and V (t) is negative semi-definite, 
V{t) is upper bounded by F(0); hence, r (t), (^), 9{t)^ 6 (t) G £oo- By 

invoking Lemmas A. 11 and A. 13 of Appendix A, we can prove that r (i), 
r]^{t) e C 2 and that e{t), e{t) G £oo- Since '0^(0 ^ ^ 00 ^ (3.28) can be 
used to prove that '0(^) G Coo- Since r]^ (t), G £00 (3.27) can be used 
to show that rj^ (t) G Coo- By Definition A.l in Appendix A, the product of 
an Coo function with an £2 function is also £ 2 ; hence, (3.27) can be utilized 
to show that r]^ (t) G £ 2 . Since cJd{i) and uJd{t) are selected as bounded 
functions of time, lj (t), u (t) G £00 • Given the preceding facts, (3.46) and 

(3.47) can be used to prove that Td (t), 6 (t) G Coo- The expressions given 
in (3.17) and (3.19) can be used to prove that fio (0> (0 ^ ^00 ? and from 

(3.25), u(t) G £oo- Prom (3.32) and (3.48), r(t), (t) G £ 00 , and hence, 

'ip(t) G Coo- After taking the time derivative of (3.27), it can be seen that 
fj^ (t) G Coo- Since rj^ (t), r(t) G Coo H £2 and r (t), fj^ (t) G £00 , Barbalat’s 
Lemma (see Lemma A. 16 of Appendix A) can be invoked to prove that 

lim r{t), risit) = 0. (3.54) 

t—*oo 

By invoking Lemma A. 15 of Appendix A, the result given in (3.50) can 
now be obtained. □ 

3.2.6 Experimental Setup and Results 

Experiments were conducted on a three-phase induction motor (Baldor 
Electric Co., Model M3541) powered by three linear amplifiers (Techron, 
Model 7570-60) to compare the performance of the standard IFOC scheme 
to that of the improved IFOC scheme for a rotor velocity tracking applica- 
tion.^ The rotor position was measured using a 10,240 line shaft-mounted 
encoder (BEI Inc.). The rotor velocity was obtained using a backward dif- 
ference algorithm applied to the rotor position signal with the resulting 
signal being passed through a second-order digital filter. The control al- 
gorithm was computed on a Pentium processor running under the QNX 
operating system at a sampling frequency of 2.0 [kHz]. Qmotor 3.0 [24] was 
used as the graphical user interface. The Quanser Consulting MultiQ I/O 



^The standard IFOC design of [7] can be easily augmented for velocity tracking 
applications through simple modifications to the desired torque command. 
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board was used to deliver the three-phase voltages to the induction motor. 
To achieve the command current of (3.11), a high-gain current feedback 
control algorithm applied to the stator windings of the motor was imple- 
mented. That is, the stator voltage applied to the terminals of the motor 
is given by the following expression 

Vs = k{u-Is). (3.55) 

In (3.55), Vs{t) G denotes the stator voltage input in the rotating ro- 
tor reference frame, u{t) G M? represents the command input current of 
(3.11), Is{t) G M? represents the measured stator current in the rotating 
rotor reference frame, and /c G R denotes a constant positive control gain. 
Three Hall-effect sensors (Microswitch, Model CSLBIAD) were used to 
measure the stator phase currents. Figure 3.2 depicts a block diagram of 
the experimental setup. 
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FIGURE 3.2. Block diagram configuration of the induction motor experimental 
setup. 



An inertia wheel attached to the rotor formed the mechanical load for 
the system. The total system inertia Jm including the rotor inertia was 
calculated to be 0.044 [kg • m^]. The coefficient of viscous friction B was 
experimentally determined to have a nominal value of = 0.007 [Nm • s]. 
The shaft of the induction motor was directly coupled to a separately ex- 
cited direct current motor (Baldor Electric Co., Model CD3433) to provide 



3.2 Induction Motor 107 



a constant load torque of Tl{uj) = 0.75 [Nm]. By using standard mea- 
surement procedures and the motor data sheet, the nominal values of the 
remaining system parameters were determined to have the following values: 



-0.14 [H], Rr = 1.99 [n], 
M-0.12 [H], and Up - 1.0. 



(3.56) 



For the experiment, the desired rotor velocity trajectory was selected as 
the following soft-start trajectory 



ujd — 500(1 — exp(— 0.015^^)) [rpm] (3.57) 



and the desired rotor flux norm 6d(t) was selected as the following constant 
value 6d = 0.62 [Wb] (i.e., 6d = 0). The standard IFOC scheme given in 
(3.11-3.15) with the following torque trajectory structure was implemented 
(i.e., a Pl-based feedback control law) 

Td = y -i- kse-\- ksh / e{a)da. (3.58) 

Jo 

In (3.58), the control gains were selected as follows 

ks = 14.0, ki = 5.18, and k = 3.0. (3.59) 

The improved IFOC scheme of (3.11), (3.16-3.20), and (3.58) was also 
implemented using the same control gains as in (3.59). To illustrate the im- 
proved transient response, the rotor velocity tracking errors of the standard 
IFOC scheme as well as the improved IFOC scheme are depicted in Figure 
3.3. Plots of the actual and reference stator phase 1 currents are shown 
in Figure 3.4. To compare the performance of the two control strategies, 
the £2 norm of the rotor velocity tracking error e{t) was calculated as in 
Table 3.1. From Table 3.1, a greater than 50% reduction in the £2 norm of 
the rotor velocity tracking error can be observed. It is important to note 
that the improved IFOC scheme achieves better performance via a different 
control structure as opposed to a different set of control gains (i.e., the two 
schemes use the same control gains). 



Remark 3.3 During the experiment, a mismatch between the reference 
and actual stator currents was observed. This mismatch may be observed 
with any strategy that neglects the effect of the stator current dynamics. 
For control strategies for the full-order model of the induction motor that 
consider stator current dynamics in the control synthesis, see [15] and [26]. 
In the next section, the stator current dynamics are incorporated in the 
control design for precision position tracking applications. 
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Rotor Velocity Tracking Error 




FIGURE 3.3. Rotor velocity tracking error: standard IFOC scheme vs. improved 
IFOC scheme. 
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FIGURE 3.4. Phase 1 stator reference and actual currents for the improved IFOC 
scheme. 
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TABLE 3.1. Rotor velocity tracking error comparison 



Implemented Controller 


\ W )\\2 


Standard IFOC scheme 


5.025 s-o ® 


Improved IFOC scheme 


2.425 s-°-^ 



3.3 Switched Reluctance Motor 

As in the previous section, most existing control strategies for electric ma- 
chines assume that the stator current dynamics can be neglected (i.e., the 
motor is treated as a current-fed motor), and the flux linkage characteris- 
tics can be modeled by a linear magnetic circuit. Since these assumptions 
may not always be justifled, degraded tracking performance may result. 
Since the SRM is typically the electric machine of choice for high-precision 
position tracking applications, this section will focus on the development 
of a control design for the SRM that accounts for the nonlinearities in the 
flux linkage as well as the effects of the stator current dynamics. Specifi- 
cally, a general nonlinear model of the SRM is used to develop an adap- 
tive controller for the full-order electromechanical dynamic model. During 
the control formulation, a design condition related to the structure of the 
algebraic torque transmission relationship is developed which is used to 
construct a commutation strategy. Specifically, this design condition facil- 
itates the modification of the commutation strategy originally proposed 
in [12] to ensure that the desired torque is delivered to the mechanical 
subsystem. Provided this design condition can be satisfied and the de- 
sired current trajectory signals satisfy some mild conditions, the controller 
achieves global asymptotic position/ velocity tracking. The proposed con- 
troller requires measurement of the rotor position, rotor velocity, and stator 
current, does not exhibit any control singularities, and compensates for un- 
certain electromechanical parameters that are independent of the flux link- 
age model. As an extension to the general nonlinear model, a commutation 
strategy is also designed to account for magnetic saturation associated with 
a proposed flux linkage model. 



'^Roughly speaking, the backstepping control design procedure requires that the de- 
sired current and its time derivative be bounded if the rotor position, velocity, and 
acceleration are bounded. 
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3.3.1 System Model 

The mechanical subsystem for the SRM is assumed to be characterized by 
the following differential expression 

m 

= (3-60) 

where the subsystem states g(t), g(t), and q{t) G M represent the rotor 
position, velocity, and acceleration, respectively. In (3.60), Mm ^ ^ de- 
notes the unknown constant lumped inertia of the rotor-load, the linear 
parameterization Wm{(lA)^m represents friction and loading effects, where 
Wm{o.A) ^ is assumed to be a known first-order differentiable re- 

gression vector and Om ^ represents the unknown constant mechani- 
cal parameter vector, m G M represents the number of phases (m > 3), 
Ij(t) G M represents the phase current in the f winding, and Tj{q, Ij) G E 
denotes the torque produced by the electrical phase. ^ The per-phase 
torque of the mechanical subsystem is directly related to the flux linkage 
of the system. That is, from the flux linkage model the per-phase torque 
can be calculated as follows 

= (3.61) 

where Xj{qAj) G E represents the known flux linkage model [43]. The flux 
linkage model can also be used to compute the inductance and back-EMF 
functions associated with the electrical subsystem dynamics. That is, for 
the following electrical dynamics 



+ RIj + Bj{q, Ij)q — vj (3.62) 

the per-phase incremental inductance, denoted by Lj{qAj) ^ E , and per- 
phase back-emf, denoted by Bj(q, Ij) G E, can be calculated from the flux 
linkage as follows [43] 



Bj{(h Ij) 



dij 



and Bj{q,Ij) 



dq 



(3.63) 



where R G E denotes the unknown electrical resistance in each matched 
phase, and vj (t) G E denotes the input voltage of the phase. 



^ Since the stator phases are symmetrically wound on pole pairs, the common as- 
sumption is made for SRM systems that the mutual inductance between the phases can 
be neglected [43]. 
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Remark 3.4 To facilitate the subsequent analysis, Mm is assumed to be 
lower bounded by a known positive constant (i.e., < Mm where M^ is 

a known positive constant). In addition, it is assumed that Wm{-)^ Wm{’) ^ 

Lc ifq{t), q(t), q{t) € L^o, andL,{q,Ij), Bj(q, I,),Tj{q, I,), ^ 

e Zoo ifq(t), Ij {t) 6 ioc. 

3.3.2 Control Objective 

The primary objective in this section is to develop a controller to ensure 
that the rotor tracks a desired position/ velocity trajectory despite paramet- 
ric uncertainty in the mechanical and electrical dynamics given in (3.60- 
3.63). To facilitate the control development for the primary objective, sec- 
ondary objectives of phase currents tracking and torque tracking are also 
defined. To quantify the rotor tracking objective, a rotor position track- 
ing error, denoted by e{t) G R, and a filtered tracking error, denoted by 
r{t) G R, are defined as follows 

e = qd- q r = e-hae (3.64) 

where qd(t) represents the desired rotor position trajectory, and a G R is 
a positive constant control gain. To quantify the secondary tracking objec- 
tives, a phase current tracking error, denoted by rjj{t) G R, and a torque 
tracking error, denoted by 77 ^ (t) G R, are defined as follows 

m m 

Vj ^dj ~ Ij 'Hr ~ ^ V '^j jq^ ^dj) ~~ ^ ^ '^j {q ; ) (3.65) 

3=1 3=1 

where Idj {') ^ R represents a subsequently designed desired stator current 
trajectory. For the subsequent analysis, the standard assumption is made 
that qd (t), qd (t), qd (t), qd (0 selected to be bounded functions of time. 
It is also assumed that q{t), q{t), Ij{t) are measurable. 

Remark 3.5 Based on the definition of the current and torque tracking 
errors given in (3.65) and some mild smoothness restrictions on the struc- 
ture of Tj(q,Ij), it is clear that if the current tracking objective is met, 
then the torque tracking objective will also be met (i.e., ifr]j(t) 0, then 
Vri^) 0 y>- 

3.3.3 Adaptive Tracking Control 

Based on the structure of the coupled mechanical and electrical dynamics, 
the following control design will exploit integrator backstopping techniques. 
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That is, these techniques will be used to develop a voltage control input 
for the electrical dynamics that produces a desired torque (current) input 
that achieves the rotor posit ion/ velocity tracking objective. 

Filtered Tracking Error 

To develop the open-loop error system for the mechanical dynamics, we take 
the time derivative of r{t) of (3.64) and multiply the resulting expression 
by Mm as follows 

m 

Mmr = Mm (qd + ae) + WmOm ~ rj {q, Idj ) + (3.66) 

i=i 

where (3.60), (3.65), and the definition of e{t) given in (3.64) were used. 
To facilitate the subsequent analysis, it is assumed that the desired phase 
currents are designed according to the following commutation strategy 

m 

X] (9’ '^d.)) = Td (3.67) 

j = l 

where Td{t) G R denotes a desired torque trajectory defined as follows 

Td = Mm {qd -f ae) + WmOm + ^sT. (3.68) 

For the desired torque trajectory introduced in (3.68), G R denotes a 
positive constant control gain, and Mm(0 ^ ^m(0 ^ denote subse- 

quently designed dynamic estimates of the unknown inertia term Mm and 
unknown parameter vector 9m^ respectively. After substituting (3.67) and 
(3.68) into (3.66) and then simplifying the resulting expression, the closed- 
loop dynamics for the filtered tracking error can be obtained as follows 

Mmr = -KsV -h Mm {qd + oce) + WmOm + Vr (3-69) 

where the parameter estimate error vectors Mm{t) ^ R and 0m{t) ^ R^ are 
defined as follows 

Mm = Mm - Mm and em=0m-9m- (3.70) 

Remark 3.6 The development of the closed-loop filtered tracking error dy- 
namics assumes that a commutation strategy can he employed to satisfy 
(3.67) and (3.68). Given the structure of the coupled mechanical and elec- 
trical dynamics, we are motivated to employ integrator hackstepping tech- 
niques to develop the voltage control input. However, the use of this tech- 
nique places additional constraints on the commutation strategy. Specifi- 
cally, in addition to satisfying the relationship given hy (3.67), the use of 
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an integrator backstepping design strategy will further require that Idj (•); 
Idj (•) G Loo provided q{t ) , q{t), Td {t), Td {t) G Loo- Given these require- 
ments, not all commutation strategies (i.e., desired current trajectories) can 
be fused into the subsequent backstepping procedure. That is, a flux linkage 
model could be formulated that would render the subsequent design proce- 
dure invalid. However, there are many possible flux linkage models that are 
amenable to the design procedure, and after the subsequent stability analy- 
sis, a commutation strategy is presented that could be used to satisfy the 
assumptions on Idj (•)• 



Current Tracking Error 

Based on the closed-loop error system given in (3.69) and the fact that a 
vanishing current tracking error implies a vanishing torque tracking error 
(see Remark 3.5), we are now motivated to develop the current tracking 
error dynamics. To this end, we take the time derivative of the current 
tracking error term defined in (3.65) and substitute the current dynamics 
of (3.62) for Ij (t) to obtain the following expression 

Given the definition of the desired torque signal in (3.68), (t) can be 

expressed as a function of Mm (t), Om (t), 4 (Oj Id (t), Qd {t), and qd (t); 

therefore, fd (t) can be expressed as follows 



fd = Mm 4d +(MmOc + ks)qd + ksaqd 



, dTd ,v . dTd , dTd . , dTd .. 
dMm dOm 



(3.72) 



where 



dTd 

dMm 



— qd + ae 



drg 

dOm 



Wm{q,q) 



dTd_dWm 2 , „ , dTd _ ^ . dWm^, ,, 

rj — o ^rn CXks — Al^r^CX Ojyi kg. 

oq oq oq oq 



(3.73) 



To express (3.72) in terms of measurable signals, (3.60) is used to develop 
the following relationship for the rotor acceleration 



q = - 



Mrr 



WjnOm + ^ '^j (Q 5 -(7 ) • 



j=l 



(3.74) 




114 



3. Electric Machines 



After substituting (3.74) into (3.72), substituting the resulting expression 
for Td (t) into (3.71), and then multiplying both sides of the resulting ex- 
pression by Mm, the following open-loop current tracking dynamics for 
T]j (t) can be obtained 

MmVj ~ Mm^lj + ^2jWm0m + Mm^SjR + ^4^ ^ (3.75) 

w? ^j) 



where f7ij(g, g, t), r^ 2 j (t), fl 3 j(g,/j), {q^Ij^t) G M are measurable 
functions (see Definition B.l of Appendix B). Based on the open-loop dy- 
namics of (3.75) and the subsequent stability analysis, the voltage control 
input is designed as follows 



Vj — Lj ^KejTjj -|- 



+M, 



Lj (^, 7j) + D>2jWm^ m 4- Uj^ 



(3.76) 



where Kej G M is a positive constant control gain, R{t) G E is a dynamic 
estimate of R, and Uj (t) G M is an additional control term injected to sever 
the interconnection between the mechanical and electrical subsystem that 
is explicitly defined as follows^ [39] 



f Tj{q,Idj) -Tj{q,Ij) 



Uj = < 



dTj(qJdj) 
[ didj 



r if T]j ^ 0 
if T]i = 0. 



(3.77) 



After substituting the control input given by (3.76) into (3.75), the closed- 
loop dynamics for rjj {t) can be written as follows 



Mm'Hj — Rej MmVj “ 1 " 4 " Mm^Sj R 

4" Ll2j'Wm^m “1“ Mm 



(3.78) 



where R{t) G R denotes the following parameter estimation error 



R — R — R. 



(3.79) 



^It is important to note that the definition of Uj{t) for r]j{i) ^ 0 reduces to the 
definition of Uj{t) for r]j{t) = 0 via L’Hospital’s rule. Hence, the auxiliary control input 
Uj(t) does not exhibit a singularity or a discontinuity. 
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Based on the structure of the closed-loop dynamics given in (3.69) and 

(3.78), the parameter update laws for Rr (t), 6m (t), and Mm (i) can be 
designed as follows 



m . I m 

R= Ta ^ T2 [w^r + J2 i^2jW^Vj) 

V ^=1 



(3.80) 






if Mm ^ ^ m 

flm if Mm = M^ and > 0 M^(0) = M^ 

0 if Mm = M^ and < 0 



where the auxiliary term Qm (t) € R is defined as follows 



(3.81) 



^m=^l [-Mm^ + ^2jWm0m + Uj^ Vj^ + {QcI + Cte) 

(3.82) 

where Fi, Fa 6 R are positive constant gains, and F 2 G R^^^ is a positive- 
definite diagonal constant gain matrix. 

Remark 3.7 To avoid singularities in (3.76) and (3.82), the projection 
algorithm [37] given in (3.81) can he employed to ensure that Mm{t) is 
always positive. For further details regarding the use of a projection algo- 
rithm, see [9], [25], and [37]. 



Stability Analysis 

Given the adaptive tracking controller of (3.67), (3.68), (3.76), (3.77), and 
(3.80-3.82), global asymptotic rotor position/ velocity tracking can be ob- 
tained as described by the following theorem. 

Theorem 3.3 Given the commutation design of (3.67) and (3.68) (as- 
suming the conditions on IdjiQ^Td) given in Remark 3.6 are satisfied), the 
voltage control input given in (3.76), (3.77), and (3.80-3.82), ensures global 
asymptotic rotor position/velocity tracking in the sense that 
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Proof: To prove Theorem 3.3, we define the nonnegative function V (t) e 
. as follows 



1 1 "" 



+-rriMi + 

Based on the structure of V (t) given in (3.84), the following inequalities 
can be developed 

Ai Ikf < V < Aall^ll^ (3.85) 

where Ai, A 2 G R denote positive bounding constants defined as follows 

Ai = 1 min Amin {Tj^} , (3.86) 

A 2 = 1 max Amax {F 2 q (3.87) 

and the composite state vector z(t) e ]{^3+p+m -g (defined ^s 



- ^ R Mm 0^ 



where Amin {•} ? A^ax { } denote the minimum and maximum eigenvalues 
of a matrix, respectively. After taking the time derivative of (3.84) and 
substituting the mechanical and electrical closed-loop error systems from 
(3.69) and (3.78), the following expression can be obtained 



y = -KsV^ - KejMmTj + 



+^m ( (Q2jW^7]j) - P2 ^ 



^MmR i E - Ta"' R 



[ E {j~Mm^ + ^2jWm0m + 



-f {qd + ae) r - Ti ^ 
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After substituting (3.65) and (3.77) into (3.89) for (t) and Uj (t), respec- 
tively, and substituting (3.80-3.82) into (3.89) for the parameter estimates 

R Om (0? ^rn (0) respectively, the following upper bound for V (t) 
can be obtained^ 

V < -As llxf (3.90) 

where the positive bounding constant A 3 G R is defined as follows 

A 3 = min s, min {KejMrn}^ (3.91) 

and x(t) e is defined as 

x=[r (3*92) 

Based on (3.84) and (3.90), z{t), x (t) G £00 and x (t) G £2 (see Lemma 
A.ll of Appendix A). Given that z (t) G Coo, (3.88) can be used to prove 
that r (t), T]j (t), R{t), Mrn (i), (t) ^ £ 00 • Since r (t) e Coo, Lemma A. 13 

of Appendix A can be used in conjunction with (3.64) to prove that e (t), 
e(t), q{t), q{t) G £00 • Based on the fact that R{t)^ Mm (^), (0 ^ ^ 00 , 

(3.70) and (3.79) can be used to prove that R{t)^ Mm{i), ^m{t) ^ £oo- 
Since rjj (t) G Coo, the structural information regarding the fiux linkage 
dependent quantities discussed in Remark 3.4 as well as the restrictions 
on the desired current trajectories discussed in Remark 3.6 can be used 
to prove that Ij (t), Vj {t) G £00 • Standard signal chasing arguments can 
also be used along with (3.69) and (3.78) to prove that x (t) G £ 00 • Since 
X (t) G Coo n £ 2 , and x (t) G £005 Barbalat’s Lemma (see Lemma A. 16 of 
Appendix A) can be used to prove that 

lim x(t) = 0. (3.93) 

t— >00 

The definition of x(t) given in (3.92) can now be used to prove the phase 
current tracking error and the filtered tracking error are asymptotically 
driven to zero as follows 



li^r(t), 0 . (3.94) 

Given the definition of the filtered tracking error of (3.64) and the re- 
sult given by (3.94), Lemma A. 15 of Appendix A can be invoked to prove 
(3.83). □ 



^See Lemma B.12 of Appendix B for an examination of the inequality given in (3.90) 
for the different cases of the projection algorithm given in (3.81), 
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3.3.4 Commutation Strategy 

An inherent feature of the SRM is that it must be electronically commu- 
tated to produce motion. Based on the motor construction, the individual 
phases are energized as a function of the rotor position in order to turn the 
rotor. The commutation can be achieved through dedicated electronics or 
integrated into the controller design via a mathematical commutation strat- 
egy. Carroll, Dawson, and Leviner [12] developed a commutation strategy 
for the torque transmission equation given by Xj = L{xj)Ij, which shared 
the control responsibilities in a continuously differentiable fashion while also 
satisfying the desired current conditions described in Remark 3.6. Specifi- 
cally, each phase is assigned the responsibility of producing some fraction 
of the desired torque based on the position of the rotor. At certain rotor 
positions this fraction is small, while at other rotor positions this fraction 
may be nearly 100% of the desired torque. 

Based on the development in [12], a commutation strategy is now pre- 
sented for constructing the desired current trajectories as described by 
(3.67). The first requirement is that the structure of the torque transmis- 
sion function (i.e., rj {q^Ij) in (3.61)) allow the construction of differen- 
tiable desired current trajectories (i.e., Idj (q^Td)) which satisfy condition 
in Remark 3.6 while also allowing (3.67) to be simplified as follows 

m 

Yl9{xjhdj=Td- (3.95) 

j = l 

In (3.95), Xj{q) G M denotes an auxiliary commutation signal defined as 
xj = (Nrq - ^^ ) (3.96) 



where G R denotes the number of rotor saliencies, 'Jdj (q^'^d) ^ R 
is an auxiliary strictly positive function that is embedded inside of the 
desired current trajectory (i.e., Idj {q^dj and g{xj) is an odd 

differentiable periodic function that satisfies the following properties: (i) 



m 

g{xj) G Coo if Xj{t) G Cool (ii) = 0 for m > 3, and (hi) g{xj) has 



a periodicity of 27 t. 

Similar to the linear flux linkage model used in [12], the auxiliary function 
'ydj (•) introduced in (3.95) can be designed as follows 



= 



g{xj)rdS {g{xj)rd) 
Sx 



+ 7c0- 



(3.97) 



In (3.97), the positive design parameter 7^0 ^ R is used to set the de- 
sired per phase threshold winding current (note the parameter 7 ^^ is used 
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to prevent control singularities), 5( ) G M is defined to be the following 
differentiable function 

5(0) ® , 2\^7 a Vz(i)eR (3.98) 

^ ^ \ 1 - exp {-eoz^} for 0 > 0 ^ ^ ^ ^ 

where cq G M is a positive design parameter that determines how closely 
5(-) approximates the unit-step function, and Sri^j^Td) G M in (3.97) is 
also defined to be a differentiable function as follows 

m 

St = Y^g^(xj)S {g{xj)Td) . (3.99) 

j=i 

To clarify the motivation for the structure of (3.97-3.99), the expression 
given in (3.97) can be substituted into (3.95) as follows 

(3.100) 

After substituting (3.99) into (3.100) for 5 t (•) and then simplifying the 
result, the following expression can be obtained 

m 

+7coX^5(a;j) = Td- (3.101) 

j = l 

m 

Since ^ g{xj) = 0 for m > 3, (3.101) can be used to prove that the 
i=i 

commutation strategy has been developed such that the desired torque 
trajectory is delivered to the mechanical subsystem. That is, the desired 
current trajectory signals have been designed to satisfy the relationship 
given by (3.67). 

Remark 3.8 At first glance, it seems as if (3.97) is undefined for St {’) = 
0. However, given the definition of Xj {q) and the constraints previously 
imposed on the structure of g(xj), it is obvious that g{xj) ^ 0 for all j 

m 

simultaneously. Since ^ 9{^j) = 0 for m> 3, this implies that g{xj) <fi 0 
j=i 

for allj simultaneously. From the preceding observations and the definitions 
of S{') and St{-), it is easy to see that St{’) = 0 only when Td{t) = 0. 
After evaluating the limit of the suspect term in (3.97), it can be shown 
that 



\ 9{xj)TdS{g{xj)Td) 

Td— +0 St 



0 Va;j(i) 



(3.102) 
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since the numerator of the expression is a higher order of Td (t ) . Based on 
the result given in (3.102), it follows from (3.97) that 



lim = 7co; (3.103) 

r ,/— >0 

hence, given the form of (3.97), 'jjj (•) € Coo given that q{t), Td{t) € Coo 
(as required by condition in Remark 3.6). 



Remark 3.9 During the formulation of the current tracking error dynam- 
ics, the time derivative of the desired current trajectory is required. Given 
the fact that the above commutation strategy embeds the auxiliary variable 
7dj (■) inside of Ijj (•), the partial derivative terms required to compute the 
time derivative of derivative Idj (•) can be expressed as follows 



dlfdj ^7dj ^7 dj 

dq ~ dq d'Jdj dq 



didj ^^dj ^7dj 

dTd d^dj 9rd 



(3.104) 



where ^ ^ and ^ ^ can be determined as follows 



dxd 



dq 



9ldj ^ g{xj)S{g{xj)Td) Tdgjxj) dS{-) _ Tdg{xj)S{g{xj)Td) dSr 

dTd St St dxd S^ dxd 

(3.105) 

^7dj TdS{g{xj)Td) dg(xj) dxj Tdg(xj) dS(-) dxj 

dq St dxj dq St dxj dq 



Tdg{xj)S{g{xj)Td) dST dxj 
dxj dq 

In (3.105) and (3.106) the partial derivative terms 



dSTi-) 

dxj 



(3.106) 
dS{-) dSTi-) dS(-) 

dTd ’ dTd ’ dxj 



can be determined as follows 



dSj-) 

dTd 



2eQg‘^{xj)Tdeyip{-eog‘^{xj)T\) g{xj)Td > 0 
0 g(xj)Td < 0 



dST(-)_ ^dS(-)o 



dTd 



= E 



j=i 



dTd 






dSj-) 

dx. 



2eog{xj)Tle-xp{-eog‘^{xj)T\) 



dg{xj) 

dXn 



g{xj)Td > 0 



(3.107) 

(3.108) 

(3.109) 



0 



g{xj)Td < 0 




3.3 Switched Reluctance Motor 121 



and 



|;(29fe)S(9fe)T,)^+/(xi)®). (3.110) 

It is not possible to explicitly calculate ^ ^ and — ^ ^ ^ since the struc- 

dldj 9q 

ture of these partial derivative terms will be dependent on the specific flux 
linkage model selected. From the partial derivative calculations given in 
(3.105-3.110), the only possible singularities in (3.105) and (3.106) oc- 
cur when St {') = 0 which corresponds to Td {t) == 0. While it is difficult 
to show for any number of phases that the singularity is avoided in these 
terms, symbolic calculations similar to those given in [12] can be used to 
state the following relationships 






( 



lim „ 

Trf,->0 OTd 



m 

\j=l 



\ 



lim = 0 Vm : 
Tj -^0 aq 



3, 4,..., 10. 



(3.111) 

Hence the above commutation strategy has been constructed such that these 
partial derivatives exist as required by the condition in Remark 3. 6. If the 
structure of Tj (•) in (3.60) facilitates the design of I dj ifl^ldj 

given thatqft), Td {t) G Cooy (3.83) and (3.104) 






9^dj ’ dq 

can be used to state that Idj {’) ^ >Coo Vm = 3,4, ...,10 given that q{t), 
4 ( 0 ^ '^dit), and fd{t) G Coo (i>e., provided condition (Hi) in Remark 3.6 
is satisfied). 



Saturated Flux Linkage Model 

As stated previously, the SRM is typically operated “high” on the satura- 
tion curve, and hence, many electric machine control experts believe that 
flux linkage saturation effects should be incorporated in the overall model. 
In lieu of the linear flux linkage model proposed by [12], in this section the 
previous commutation strategy is redesigned under the assumption that 
the flux linkage model is saturated as follows 

Xj{q, Ij) = \s arctan {pLIj) . (3.112) 

In (3.112), As, P G R denote positive constant model parameters, and 
L(xj) G R is deflned as follows 



L = Lq — Li cos(xj) > 0 



(3.113) 
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where Lq, L\ G M are positive constant parameters. Based on the form of 
(3.112), the expressions given in (3.61) and (3.63) can be used to formulate 
the following electrical functions 



XgNrLi 






Xsf3L 

^ 1 + ’ 



Xs(3NrLisin{xj)Ij 

3/11 cl i O r\ r% 

' 1 + 



(3.114) 



The torque transmission equation (3.114) can now be used to reconstruct 
the desired current trajectories to satisfy the commutation design equation 
given by (3.67) based on the saturated flux linkage model. Speciflcally, 
Idj (•) must be designed to satisfy the following expression 






j=l 



(3.115) 



Based on (3.115), Idj (•) redesigned as follows 



2/3L2 

/exp I X Ar r ) - 1 



Idj — 



XgNrLi 



(3.116) 



where 7^^ (•) was deflned in (3.97). After substituting (3.116) for Idj (•) in 
(3.115), the expression given in (3.95) can be obtained; hence, the rest of 
the general design procedure follows. In addition, the remaining partial 
derivative terms in (3.104) can now be calculated as follows 



didj 

9ydj 



2L2 / 2^1,2 X 

1 




exp 



2f3L‘^ 



- 1 



(3.117) 



dIdj 

dq 



exp 



2/31,2 N 



exp 



2/3L2 

X.NrLi^^^ 



- 1 



^'Ydj 



sin{xj) -f 



L dldj \ 
X^NrLi dq ) 



NrLi sin(xj) 



exp 



XsNrL,^^^ 



^L2 



- 1 



(3.118) 
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As illustrated by (3.117) and (3.118), the structure of Tj (•) given in (3.114) 

dl f 1 dl f ) 

ensures that — - G Coo given that q (t), Td (t) G £oo- Hence, for 

d7dj dq 

the saturated flux linkage model given by (3.112), the controller exhibits no 
singularities; furthermore, all signals can be shown to be bounded following 
the argument outlined in Theorem 3.3 and Remark 3.9. 



Remark 3.10 The flux linkage model of (3.112) is motivated by the model 
given in [41] and the experimental work presented in [10]. Specifically^ [41] 
used an exponentially saturated version of the linear flux linkage model to 
develop a feedback linearizing control for an SRM while [10] used experi- 
mental results to validate the use of the arc-tangent function for modeling 
saturation in a separately excited DC machine. Since the parameter As ap- 
pears linearly in the nonlinear terms in (3.114), additional update law 
could be designed to compensate for any uncertainty associated with As/ 
however, it is not obvious how update laws can be designed to compensate 
for any uncertainty associated with j3, Lq, and L\. 



Remark 3.11 In addition to the current dynamics and saturation effects 
in the flux linkage model, torque ripple is another phenomenon that can 
affect high-performance control of the SRM, and hence, the elimination of 
torque ripple in the SRM has been a subject of intense interest for several 
decades. This ripple has been attributed to three major sources: (i) impre- 
cise torque transmission modeling, (ii) inability to track the desired current 
signal due to input voltage saturation or utilization of current-fed models 
that ignore the stator current dynamics, and (Hi) improper commutation 
of the motor. For a more detailed discussion of these sources, the reader is 
referred to [15]. 

Remark 3.12 The primary advantage of the preceding full-order model 
based controller is that the saturation effects of the flux are incorporated. 
Since the control designs for other multi-phase machines (e.g., induction 
motors, brushless DC motors) are often based on a transformed model (e.g., 
the induction motor control design given in the previous section), it is not 
obvious how saturation effects can be incorporated into a general control 
design procedure. 



3.3.5 Experimental Setup and Results 

An experiment was conducted to illustrate the performance of the SRM 
voltage controller. To implement the controller, an experimental testbed 
was constructed that consists of the following components: (i) a 486-66 
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MHz PC, (ii) a TMS320C30 DSP system board (Spectrum Signal Process- 
ing) operating with a sample time of 1 [ms], (iii) a DS-2 Motion Control 
Card to read the quadrature signals from the shaft-mounted encoder (Inte- 
grated Motions Inc.), (iv) a three-phase SRM (NSK Corp. Model RS-0810), 
(v) six linear amplifiers (Techron, Model 7570-60) connected in a master- 
slave configuration to power the motor with a possible of 4 [kW/pair], (vi) 
Hall-effect sensors (Microswitch, Model CSLBIAD) to measure the phase 
currents, and (vii) assorted electronics and hardware for signal conditioning 
(see Figure 3.5). 



Host 

Con-puier 

4S6 

?oo€tssor 



DS? svsterv: 
board 
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ArnpNtlers 
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1 
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FIGURE 3.5. Block diagram configuration of the SRM experimental setup. 

A large inertial load was connected to the SRM. The load can be modeled 
as follows 



J 



Jr + 



2 ( ^m2r| + m.2li 



2 + ”^3^2 



where € M represents the rotor inertia, mi, m 2 , m 3 G M denote the 
cylindrical weights, ri, r 2 , ^3 G K are the radii of the cylinders, and /i, 
^2 G R are the distances of the weights from the axis of rotation. In addition 
to the inertial load, the motor was also connected to an electromagnetic 
brake. A constant voltage of 20 [V] was applied to the brake to maintain 
uniform braking on the rotor. Since the load used in the experiment is 
only dependent on the rotor velocity, the linear parameterization Wm(-)0m 
defined in (3.60) is given by the following expression 



WmOm = Bq-\- as arctan(lOOg) 



(3.119) 
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where B E R is the coefficient of viscous friction, and cr^ G E is the coef- 
ficient of Coulomb friction. The modeling term cr^ arctan(lOO^) is used to 
account for the Coulomb friction in the motor and the torque applied by 
the brake. Through experimental trials, it was determined that the value 
of 100 associated with the argument of the arc-tangent function resulted in 
a close approximation of the signum function and did not introduce signifi- 
cant spikes in the voltage control inputs when the rotor velocity alternated 
signs. The rotor velocity signal was obtained by applying the backwards 
difference algorithm to the position signal. The resulting signal was then 
passed through a second-order digital filter. Based on previous experience, 
this method provides an adequate surrogate for the velocity signal in the 
absence of an output feedback control strategy. The various other para- 
meters of the SRM were determined experimentally from standard test 
procedures or obtained from the manufacturer data sheets as follows 

Jr = 0.02 [kg • m^] mi = 4.756 [kg] m2 = 22.68 [kg] 

m3 = 12.43 [kg] ri = 0.1803 [m] V 2 = 0.2479 [m] 

T3 = 0.2254 [m] h = 0.293 [m] h = 0.3606 [m] 

B = 0.02 [Nm • s • rad’^] Nr = 150 Lo = 0.189 [H] 

cr, = 1.3 [Nm] Li = 0.044 [H] R = 8.2 [Q]. 

The flux linkage model for the experiment was calculated by aligning 
the rotor with one of the phases and then energizing that phase with a 
sinusoidal voltage of known amplitude and frequency. The resulting current 
through the winding was then recorded and the flux linkage was calculated 
using the following relationship (see (3.62) and (3.63)) 

Xj = [ {vj — RIj)dt. (3.120) 

Jo 

As described by (3.112), an arc-tangent function was used to approximate 
the saturated flux linkage as follows 

Xj = 0.5arctan(1.8L(xj)/j) (3.121) 

where L{xj) was introduced in (3.112). Figure 3.6 shows a comparison of the 
linear flux model defined by Xj = L{xj)Ij, the experimentally calculated 
flux given by (3.120), and the arc-tangent approximation defined in (3.121). 

To illustrate the performance of the control strategy and to examine the 
effects of saturation in the flux model, experimental results were obtained 
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FIGURE 3.8. Position tracking error for the saturated flux controller. 
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FIGURE 3.9. Adaptive estimates of unknown parameters. 
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by implementing a controller based on a linear flux model and a controller 
based on a saturated flux model. The desired rotor position trajectory for 
each experiment was selected as follows 

Qd = 0.8sin(0.8(— 0.25sin(0.1t) -f- 1.0)t)(l — exp(— 0.05t^)) [rad] 

where the initial condition for the desired rotor position and its first three 
time derivatives were selected as zero. Each controller was also implemented 
with the unknown parameters initialized to 80% or lower of their nominal 
values. To implement the controller based on the linear flux model, the 
following control gains were selected 

o = 160 Ks =20 Ke = 750 

Ti = 0.001 T2 i = 0.002 T22 = 0.005 (3.122) 

T3 = 0.5 7,^ = 0.2 6o = 15.0. 

As illustrated in Figure 3.7, the steady state position tracking error for 
this controller was determined to be approximately 0.09 [deg]. To imple- 
ment the controller based on the saturated flux model, the following control 
gains were selected 



a = 140 Ks =80 Ke= 600 
El = 7 X 10-^ E2i = 0.02 E22 = 0.001 (3.123) 

Ea = 0.03 7co = 0-2 = 15.0. 

As illustrated in Figure 3.8, the steady state position tracking error for 
this controller was determined to be approximately 0.03 [deg] after a 10 [s] 
transient. For the nonlinear controller utilizing the saturated flux model, 
the dynamic estimates of the unknown parameters are depicted in Figure 
3.9. 

3.4 Active Magnetic Bearings 

The electric machines described in the previous sections are modeled by 
coupled nonlinear ODEs that represent the mechanical and electrical dy- 
namics. In a similar manner, the differential equations that describe a mag- 
netic bearing can be subdivided into the mechanical subsystem dynamics, 
an algebraic force transmission relationship, and the electrical subsystem 
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dynamics. Standard calculations can be applied to the flux linkage model to 
complete the description of the electrical subsystem dynamics and the al- 
gebraic force transmission relationship in a similar manner as in the model 
development for the SRM. 

In this section, the rotor position of a 6-DOF vertical rotor shaft AMB 
system (see Figures 3.10 and 3.11) is forced to track a desired trajectory. 
To this end, a desired force trajectory signal is first designed to ensure 
that the rotor position tracks a desired trajectory. Then, the structure of 
the algebraic force transmission relationship is used to develop the desired 
current trajectory, which ensures that the desired force is delivered to the 
mechanical subsystem. The desired current trajectory signals are then used 
to motivate the design of a voltage control input for the electrical subsystem 
dynamics. An example flux linkage model is also provided to illustrate how 
the desired current trajectory signals can be constructed® to ensure that 
the desired force is delivered to the mechanical subsystem (i.e., the desired 
current trajectory signals satisfy the static equation associated with the 
algebraic force transmission relationship). 



Remark 3.13 For the AMB system depicted in Figure 3.11, the {xt,yt) 
and (xb,yb,Zb) axes are fixed at the center of the top and bottom radial 
magnetic hearing systems, respectively. The {xo,yo^Zo) frame is a moving 
coordinate system attached to the rotor center of mass that coincides with 
its principal axes such that the Zq axis is aligned with the rotor longitudinal 
axis. 



3.4.1 System Model 

As illustrated in Figures 3.10 and 3.11, the AMB system consists of a rigid 
circular cylinder rotor suspended by several AMBs. A brushed DC (BDC) 
motor (not shown in Figures 3.10 and 3.11) is used to provide rotation of the 
rotor about its longitudinal axis. Specifically, a set of the AMBs depicted 
in Figure 3.10 are used to regulate the radial motion of the vertical rotor 
[31], while another set of AMBs are used to regulate the rotor axial motion 
as shown in Figure 3.11. 



*This procedure is equivalent of the commutation strategy procedure developed in 
the previous section for the SRM. 




130 



3. Electric Machines 






+ - 




FIGURE 3.10. Top view of a vertical shaft AMB system. 



A mathematical model of the mechanical subsystem can be written as 
follows^ 

M{q)q + Kn(g, q)q + G{q) = F{q, Uj). (3.124) 

The matrix coefficients M{q) e Vm{qA) ^ G{q) G R^ of 

(3.124) are explicitly defined in Section B.2.3 of Appendix B, and F(g, lij) G 
R^ represents the following transmitted force/torque vector 



-^(^? -^u) 



j=l j=l 



E (-1)^ + 1 (93, /3^.), E 

j=l j=l 

2 , r 

E (-1)'’^ P'^jiQbihj), Fei{qe,Iei) 

j=i 

(3.125) 



^The mechanical dynamics associated with the rotor flexibility and unbalance, and 
the physical connection between the BDC motor and the rotor (i.e., the drive train) 
have been neglected to simplify the control design. 
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FIGURE 3.11. 6-DOF vertical shaft AMB system. 
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In (3.125), Fij{-) G M Vi == 1, 5 and j = 1, 2 denote the absolute values of 
the forces produced by each electromagnetic circuit, G M Vi = 1, ..., 5 
and j = 1,2 denote the currents in the AMB windings, ^ 61 (^ 65 ^ 61 ) ^ ^ 
represents the torque produced by the BDC motor, and leiit) G M repre- 
sents the current in the windings of the BDC motor. In (3.124) and (3.125), 
q(t) G R® represents the rotor position vector where the components qi(t), 
Vi = 1, 4 represent the rotor position along the directions and 

2/6, respectively (i.e., the position of the point of intersection of the ro- 
tor longitudinal axis with the planes formed by (xt,yt) and {xh^yh))^ the 
component q^ (t) represents the position of the bottom end of the rotor lon- 
gitudinal axis along the axis, and qe{t) denotes the rotation of the rotor 
about the Zo axis (see Figure 3.11). Kinematic functions relating the posi- 
tion vector q {t) to sensor measurements must be determined to facilitate 
the control implementation. In small gap applications, an approximation of 
this relationship is relatively straightforward to determine. However, in ap- 
plications where the gaps cannot be considered “small” with respect to the 
radii and Vg (see Figure 3.10), the kinematic functions are more difficult 
to derive. Specifically, the intersection of the circular cylinder rotor with 
the planes formed by (xt^yt) and {xt^yt) will result in two ellipses whose 
center and major and minor axes will vary in time as the rotor moves. If 
four position sensors are located at the top and bottom bearings (see Fig- 
ure 3.11) with measurement beams aligned with the yt, x^, and yi axes, 
respectively, the kinematic functions relating the center of the two ellipses 
(i.e., the points (^^ 1 ,^ 2 ) and (^ 3 ,^ 4 )) with the sensor measurements can be 
determined. 

While the definition for the magnetic forces given in (3.125) are presented 
in a very general form, the common simplifying assumption is made that 
the applied magnetic forces are only dependent on the direction of ma- 
jor motion and the measured current in the coil winding (i.e., Fij{-) only 
depends on qi (t) and lij (t)). The flux linkage model allows for the compu- 
tation of the model for the force produced by each electromagnetic circuit. 
Specifically, the model for the magnetic bearing forces (i.e., V i = 1, 2, ..., 5 
and j = 1, 2) can be computed as follows [49] 

lij 

Fij (QiJij) ^ ^ (QiJij)dlij (3.126) 

0 

where Xij (qi,Iij) G R represents the flux linkage model. In addition, the 
flux linkage model allows for the computation of the electrical subsystem 
dynamics of the magnetic bearings (i.e., for V z = 1, 2, ..., 5 and j = 1,2) as 
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follows [49] 

Liji^Qii “h Rijiij “h Rj)Qij — '^ij • (3.127) 

In (3.127), Vij (t) € M denotes the input voltage, Rij G R denotes the 
electrical resistance, Lij{qi,Iij) G M denotes an incremental inductance 
quantity (which is assumed to be positive), and Bij{qi,Iij) G M denotes 
the back-emf. The inductance and back-emf terms introduced in (3.127) 
can be calculated as follows [49] 

= (3-128) 

The dynamic system given in (3.124) exhibits the following properties 
that are used in the subsequent control development and stability analysis. 

Property 3.1: Symmetric and Positive-Definite Inertia Matrix 

The inertia matrix is symmetric positive-definite and satisfies the follow- 
ing inequalities 

^1 ll^ll^ ^ M{q)x < m 2 {q) \\x\\^ Vx G (3.129) 

where mi, m 2 G R are known positive constants, and H-H denotes the 
standard Euclidean norm. 

Property 3.2: Skew-Symmetry 

The inertia and centripetal-Coriolis matrices satisfy the following skew- 
symmetric relationship 

Qm(9) - Vm(q, q)^x = 0 \fx€ E® (3.130) 

where M{q) denotes the time derivative of the inertia matrix. 

Remark 3.14 For a simple BDC motor, a linear magnetic circuit model 
can be used to complete the description of the dynamical model (i.e., i = 6 
and j = 1 in (3.125) and (3.127)) as follows [40] 

F^M,hi) = Krhi (3.131) 

and 

Le\{(lQ,hi) = L&i ^6i(^6)^i) = ^61 (3.132) 

where Lqi, Bqi, and Kr G R denote positive constants. 

Remark 3.15 For the subsequent analysis, it is assumed that Fij {qi^Iij), 
Fij Rj ) 7 7 QJ - ^ Roo provided qi{t) 

and I%j (l) ^ Roo * 
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3.4.2 AMB Tracking Control 

The typical objective for an AMB problem is to regulate the rotor to a con- 
stant setpoint. To provide increased flexibility, the objective in this section 
is to develop a voltage control input to force the rotor position to track a 
desired trajectory (i.e., a “soft” desired position trajectory signal could be 
used when the bearing is initially energized). To quantify this objective a 
rotor position tracking error, denoted by e{t) G R®, and a filtered tracking 
error, denoted by r{t) G R^, are defined as follows 

e = Qd — q r = e-\-ae (3.133) 

where qd{t) G R^ represents the desired position trajectory, and a G R is 
a positive control gain. As a means to develop the rotor position tracking 
controller, a desired current trajectory input is first constructed to ensure 
that the magnetic bearings produce the desired forces on the rotor shaft to 
achieve the desired trajectory. Integrator backstopping techniques are then 
used to construct a voltage control input that forces the actual current 
trajectory to follow the developed desired current trajectory. A current 
tracking error, denoted by (t) G R, is defined as follows to quantify the 
current tracking objective 



Vij ~ ^dij ~ ^ij (3.134) 

where Idij {q^ fd) ^ R denotes the subsequently designed desired current 
trajectory signal, and fd{Q^Q,t) ^ R^ denotes the subsequently designed 
desired AMB force trajectory. For the subsequent development, it is as- 
sumed that g (t), q (t), and Uj (t) are measurable, that qd (t), qd (t), qd (t), 
Qd (0 ^ ^cx )5 and that the electromechanical model is exactly known. In 
addition, it is assumed that Idij (0 ^ ^oo provided that q (t), fd{’) ^ >Coo, 
and that Idij (•) ^ ^oo provided that q (t), q (t), fd (•), fd (•) € Coo- 

A force/torque tracking error, denoted by 77 ^ (t) G R^, is defined as fol- 
lows 

Vf = F{q, Idij) - F(q, Fj) (3.135) 

to quantify the mismatch between the desired and actual transmitted force/ 
torque vector defined in (3.125). In (3.135), F{q^Idij) denotes the desired 
force/torque profile that is defined later in this analysis. 

Rotor Position Tracking 

After using the tracking error definitions of (3.133) and (3.135), the me- 
chanical subsystem dynamics of (3.124) can be written as follows 

M{q)f = -Vm{q, q)r + w{q, q, t) - F(q, Idij) + Vf 



(3.136) 
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where the force/torque tracking error {t) is defined (3.135), the desired 
force/torque profile F{q,Idij) is defined later in this analysis, and the aux- 
iliary term w{q,q,t) G R® is defined as follows 

w{q,q,t) = M{q) {qd + ae) + Vm{q,q) (% + cce) + G{q). (3.137) 

Based on the structure of (3.136), the desired current trajectory signal 

^dij fd) is designed to satisfy the following equation 

F{qJdij) = fd (3.138) 

where the desired AMB force trajectory is defined as 

fd = w{q, g, t) -h ks\2{q)r. (3.139) 

In (3.139), G R denotes a positive control gain, and A 2 (g) € R denotes 
the following positive function 

A2(g) — max{m2(g), 1}. (3.140) 

After substituting (3.138) and (3.139) into (3.136) and then simplifying the 
resulting expression, the following closed-loop dynamics can be obtained 

M{q)r = -ks\ 2 {q)r - Vm{q, q)r-\~Vf‘ (3.141) 



AMB Force and Current Tracking 

To formulate a voltage control input that ensures that the actual AMB 
forces track the desired forces (i.e., to ensure that the actual current tracks 
the desired current), we take the time derivative of (3.134) and then sub- 
stitute the electrical subsystem dynamics of (3.127) for to obtain the 
following expression 

^ ^ ^ LijiqiJij) ^ ~ ■ 

(3.142) 

Given the definition of the desired force signal defined in (3.139), fd {t) can 
be expressed as follows 

f _ n •• ,dfd. , dfd . . . 

jd — + x — qd~^-^q (3.143) 

oqd dqd dqd dq 



[M-\q) {HqJij) - Vm{q,q)q - g (?))] 

where (3.137) and (3.139) can be used to compute the partial derivatives 

dfdi^) dfd{-) a/,(.) dfd{‘) ,dfd{^) , 

— , — 7 T . — 5 , — 7 ^ — 5 and — — — (see Definition B.2 of Appendix 

oqd dqd dqd dq dq 
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B) and (3.124) was utilized. Based on the partial derivative expressions 
given in Section B.2 of Appendix B and the assumption of exact model 
knowledge of the mechanical parameters, the expression for fd{i) given in 
(3.143) is measurable. After substituting (3.143) into (3.142) for fd{’), the 
following open-loop current tracking dynamics can be obtained 



Vij — n^j 



^ij j ^ij ) 



(3.144) 



where Uij {t) 6 M is a measurable auxiliary function defined as follows 



— 



^^dij 



dfd ,9fd.. dfd ... 

■5r + -95"''"W 



H?) {F{qJij) - Vm{q,q)q - G{q)) 



d I 1 

^ Lijiquiij) ■ 

(3.145) 

Based on the open-loop dynamics of (3.144) and the subsequent analysis, 
the voltage control input Vij (t) is designed as 



Vij = Lij{qi, lij) {ke\ 2 {q)'nij + Ilij + Uij) (3.146) 

where /cg G M is a positive control gain, \ 2 {q) was defined in (3.140), and 
Uij (t) e R is an auxiliary control input utilized to sever the interconnections 
between the mechanical and electrical subsystem, defined as follows [39] 



f {^ij {qi} ^dij) ^ijiqiT^ij)) 



Uij — 



< 



Vij 

iVi 5 ^dij ) 



if Vijit) 7^ 0 



if Vij{t) = 0 



(3.147) 



where r,(i) denotes the element of r{t). After substituting the control 
input given by (3.146) into (3.144), the closed-loop dynamics for rjij{t) can 
be written as follows 



Vij = -ke>^2{q)Vij - (-1)'’"^^ Uij. (3.148) 



Stability Analysis 

The voltage control input introduced in (3.146) and (3.147) confines the 
transient and steady state response of the rotor position tracking error 
to an exponentially decaying envelope provided a commutation strategy 
is selected to ensure that (3.138) and (3.139) are satisfied. This fact is 
stated in mathematical terms and is proven through the following stability 
analysis. 
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Theorem 3.4 Provided (3.138) and (3.139) are satisfied, the voltage con- 
trol input given in (3.146) and (3.147) ensure global exponential rotor po- 
sition tracking in the sense that 



^2(g(Q)) ||p(0)||exp(-A3^) (3.149) 

Ai 

where p{t) G is defined as follows 

P=[r'^ T^ii t]i 2 V21 V22 V31 V32 (3.150) 

V 4 I V 42 Vsi ^52 ^61 J ’ 

^2(9) defined in (3.140), and Ai, A3 G M are defined as follows 

Xi=min{mi,l} X3 = min{ks,ke} ■ (3.151) 

Proof: To prove Theorem 3.4, we define the nonnegative function V (t) G 
E as follows 

V = \r'^M{q)r+^J2Y^^l + \^ei- (3.152) 

i=l j=l 

Based on the structure of (3.152), the following lower and upper bounds 
can be developed 

\\i\\pf <v <l\2{q)\\pf (3.153) 

where A2 (^), p{t), and Ai are defined in (3.140), (3.150), and (3.151), re- 
spectively. After taking the time derivative of (3.152), substituting for the 
closed-loop error systems given in (3.141) and (3.148), and using the skew- 
symmetry property given by (3.130), the following expression can be ob- 
tained 



|r(^)|| < |b(i)ll < 



5 2 

V = -ksX2{q) Ikll^ - ke\2{q) ^ V% ~ ke\2{q)ri6i (3.154) 

i=l j=l 

+r'^7]f - r?6iU6i - 

Z = 1 j = l 
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After substituting (3.125) and (3.135) into (3.154), V{t) can be rewritten 
as follows 

V = -ks\ 2 {q) l|r||^ - k^Miq) E E vfj ~ ke>^2iq)vh 

i=ij=i 

+ri=e (Fei{qe,Idei) - ^ 61 (^ 65 ^ 61 )) - 

+ X/ {Fij[qi^ Idij) — Fij{qi^ lij)) — 'f]ijUij'\ • 

i=i j=i 

(3.155) 

When = 0 (i.e., Idij{t) = then the definition of given in 

(3.135) can be used to prove that rif{t) = 0; hence, (3.155) can be written 
as follows 

5 2 

V = -ksMiq) \\rf - keX2(q)'^'^vlj ~ keX2{q)V6i- (3.156) 

i=l j—1 

When T]^j{t) ^ 0, the definition of Uij{t) from (3.147) can be substituted 
into (3.155) to yield the same result given by (3.156). The expression given 
in (3.156) can be upper bounded as follows 

V < -\3\2iq) \\pf (3.157) 

where (3.150) and (3.151) were utilized. After using (3.153), the inequality 
in (3.157) can be further upper bounded as follows 

V < - 2 X 3 V. (3.158) 

After solving the differential expression given in (3.158) (See Lemma A. 10 
of Appendix A), the inequality given in (3.149) can be obtained. Since the 
position tracking error is related to the filtered tracking error according 
to the linear differential equation given by (3.64), Lemma A. 14 of Ap- 
pendix A can be invoked to show that the position tracking error is also 
upper bounded by an exponentially decaying envelope. From the above 
information and the structure of both the voltage control input and the 
electromechanical system, all of the system signals remain bounded during 
closed-loop operation. 

Remark 3.16 To compensate for the uncertainty associated with electro- 
mechanical parameters that appear linearly in the model, the above con- 
troller could be redesigned as an adaptive tracking controller that achieves 
global asymptotic rotor position tracking. For details regarding this exten- 
sion, see [8]. Under certain conditions on the structure of the electro- 
mechanical dynamics, the adaptive controller may also be further modified 
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to eliminate the requirement for velocity measurements. The control design 
given in [11] for robot manipulators can be used to illustrate this extension. 



3.4.3 Commutation Strategy 

If fringing effects and leakage currents are neglected and the magnetic cir- 
cuit is assumed to be linear, the following flux linkage model is often used 
to complete the description of the AMB model of Section 3.4.1 [38] 

XijiqiJij) = Lij{qi)Iij Vi - 1,2,... ,5 (3.159) 



where Lij(qi) G M is a positive inductance term. The flux linkage model 
given by (3.159) can now be used to calculate the quantities given by (3.126) 
and (3.128). For example, Fij{qi,Iij) of (3.126) is explicitly given by 

lij) = 5 Vi = 1, 2, 5. (3.160) 

Based on this development, the flux linkage model given by (3.159) can 
be used to design the desired current trajectories such that the design 
equation given by (3.138) is satisfied. Specifically, after substituting (3.160) 
into (3.138), Idij (•) can be constructed as follows 

(- 1)^+1 Vi = 1,2,..., 5 (3.161) 



where fdi (•) denotes the i*'' component of the vector fd (•). To satisfy 
(3.161), Idij (•) can be designed as follows 



Idij — 



dLijjqi) 

dqi 



y/Ydij Vi = l,2,...,5 



(3.162) 



d L ’ ’ ( ’ j 

where it is assumed that — > 0 for all qi (t), and (•) G K is an 

auxiliary function that must be designed to be nonnegative. After substi- 
tuting (3.162) into (3.161) for Idij (•)> Idij (’) t>e designed to satisfy the 
following relationship 



= fdv, 



(3.163) 



j = l 



therefore, 7 ^^ (•) can be designed as follows 



Idij = (-1)^'^^ fdi + \J {fdif + 7o 



(3.164) 
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where the positive design parameter 7 q G M is used to set the desired thresh- 
old winding current. Motivation for the structure of (3.164) is obtained by 
substituting (3.164) into (3.163) for 7^^^- (•) as follows 

2 fdi + -\j Udif' + 7o + 2 fdi - 2 \/ Udif' + 7o ~ fdi' (3.165) 

The expression given in (3.165) illustrates that the desired current trajec- 
tory given by (3.162) and (3.164) ensures that the desired force trajectory 
is delivered to the mechanical subsystem as required by (3.138) and (3.139). 

Remark 3.17 Based on the structure of (3.164), the following result can 
be obtained 

^11^0 7dij = \lo Vi = 1,2, ...,5. (3.166) 

Based on (3.162), (3.164), and (3.166), it can be determined that'j^^j (•), 
^dij (’) ^ ^oo giy^^ that Qi (l') , fdi (") ^ ~ 1, 2, 5. 

Remark 3.18 The formulation of the current tracking error dynamics re- 
quires the calculation of two partial derivatives associated with Idij {q, fd) 

Or T 

(i.e., (^-14^))- Based on (3.162) and (3.164), the i^^^ 

component of these partial derivative terms can now be calculated as follows 



did 



dfd 



dij \ _ 



OLij {qi) 
dqi 






(-1)^+' + 



fdi 



\J {fdi) 






and 



Vi = 1,2,..., 5 



(3.167) 



didij 

dq 



dL/iji^Qi'j 

dqi 



Vi = 1,2,..., 5. (3.168) 



Hence, the desired current trajectory signal has been constructed such that 
the above partial derivatives can be calculated. From the stability result given 
in ( 3 . 149 ) and the structure of (3.167) and (3.168), Idij (') ^ I^oo given 
that qi{t), qi(t), fdi(-), and fdi{-) S Coo Vi = 1,2, ...,5. Motivation for 
including the desired threshold winding current design parameter 7 q during 

the construction of (3.164) is due to the structure of and ■ . 

dfd dq 

Specifically, as a result of (3.166), the use o/ 7 q ensures that the partial 
derivatives of Idij (•) remain bounded as fdi{t) 0. 
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Remark 3.19 The design of the desired current trajectory for the BDC 
motor is more direct than the technique used for the A MB. After substitut- 
ing (3.131) into (3.138), the desired current trajectory Id6i(Q^fd) can be 
constructed to satisfy the following expression 



Krld6l=fdi- (3.169) 

From the structure of (3.169), it is straightforward to design the desired cur- 
rent trajectory and hence, the required partial derivative terms in (3. If 2). 



3.5 Background and Further Reading 

Over the last decade, many induction motor control schemes have been de- 
veloped with an IFOC-like control strategy at the core of the controller as 
a means to examine this control problem from a nonlinear control perspec- 
tive as opposed to a more classical motor control perspective. For example, 
Espinosa-Perez and Ortega [17] presented a singularity-free velocity track- 
ing controller that did not require rotor flux measurements; however, the 
performance of the controller was limited because the convergence rate of 
the velocity tracking error was restricted by the natural damping of the 
motor. Ortega, Nicklasson, and Espinosa-Perez [32] improved upon [17] by 
using a linear Altering technique to remove the damping restriction in [17]. 
Furthermore, the authors of [32] illustrated that for a desired constant ve- 
locity, the control algorithm of [32] reduced to the IFOC scheme [7]. In [14], 
Dawson, Hu, and Vedagarbha modifled the control structure and stability 
analysis presented in [32] to construct an adaptive rotor position tracking 
controller which can be analyzed using standard Lyapunov- type arguments. 
Ortega et al. illustrated global asymptotic stability of the IFOC control 
scheme for rotor velocity setpoint applications in [34]. In [33], Ortega and 
Taoutaou illustrated how previously designed passivity-based control algo- 
rithms such as [35] can be expressed in the IFOC notation. With this link 
between the notation, Ortega et al. illustrated global asymptotic speed reg- 
ulation for current-fed induction motors with a constant load torque. How- 
ever, this proposed control algorithm appears to contain a possible control 
singularity in the stator current control input. The observer/controller al- 
gorithm of [33] does not appear to recover exponential stability even if the 
load torque is assumed to be known (i.e., an adaptive algorithm is required 
to compensate for the unknown initial conditions of the rotor flux). The au- 
thors of [16] analyzed the effects of varying the rotor resistance parameter 
in the indirect fleld-oriented control scheme on system stability. An output 
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feedback controller was designed in [27] which achieved global exponential 
rotor velocity/rotor flux for the reduced-order model of the induction mo- 
tor (i.e., current-fed induction motor). In addition, Marino, Peresada, and 
Tomei illustrated how the controller in [27] could be modified to compen- 
sate for the parametric uncertainty associated with the load torque and the 
rotor resistance parameter; however, the controller exhibited a singularity 
at motor start-up (see [28] for the original adaptive observer design). In 
the subsequent paper given in [26], Marino, Peresada, and Tomei removed 
the restriction in [27] by designing the controller for the full-order model. 
In [5], Behai, Feemster, and Dawson demonstrated how an improved IFOC 
design could be formulated to achieve exponential rotor tracking. The re- 
sult in [5] also demonstrated how to transform the improved IFOC design 
into a structure that facilitates Lyapunov analysis techniques. Other in- 
duction motor designs using a Lyapunov-based approach include [2, 4, 18]. 
Speciflcally, the induction motor control problem is solved using an adap- 
tive algorithm for estimation of rotor resistance in [18]. In [2], Aquino et al. 
designed a control algorithm for induction motor position tracking applica- 
tions where the rotor resistance parameter was estimated in the absence of 
rotor velocity measurements. In [4], Behai et al. designed a rotor position 
tracking controller for an induction motor model that included saturation 
effects in the magnetic flux. 

Significant efforts have been directed toward developing controllers for 
the SRM since it is a popular electric machine for high-precision applica- 
tions. For example, in [41], Ilic’-Spong et al. introduced a detailed nonlinear 
model and an electronic commutation strategy for the SRM and applied 
a feedback linearizing control algorithm that compensates for the nonlin- 
earities of the system. Given the assumption of constant motor velocity, 
Ilic’-Spong et al. [42] also introduced an instantaneous torque control for a 
SRM driving an inertial load. A composite control, based on a singularly 
perturbed model, using reduced-order feedback linearization techniques is 
presented by Taylor in [43] to reduce torque ripple in the actuation of an ex- 
perimental load. A torque ripple study of SRMs was pursued in [47] where 
Wallace and Taylor investigated the performance of four related motors us- 
ing finite-element analysis. Wallace and Taylor also presented a new method 
of computing the reference currents by utilizing a balanced commutator for 
current tracking feedback control in [48] . A certainty equivalence argument 
was used by Taylor in [44] to develop an adaptive feedback linearizing 
control for a single link robot with SRM actuators. Carroll, Dawson, and 
Leviner used a backstepping technique in [12] to develop a singularity- free 
adaptive trajectory tracking controller for an SRM driving an inertial load. 
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In [1], an instantaneous torque measurement method based on flux observa- 
tions was used to develop an adaptive feedback linearizing torque controller 
for a three-phase SRM. In [21], an adaptive control for SRMs was developed 
that used B-spline functions to model the torque transmission relationship. 
A commutation strategy was designed in [20] for a sophisticated model of 
the SRM. In [45], Vedagarbha, Dawson, and Rhodes designed an adaptive 
controller for SRMs which does not require rotor velocity measurements. 
In the subsequent paper [46] , Vedagarbha et al. also developed an SRM 
controller that compensates for uncertainty in an electromechanical model 
that utilizes a flux linkage model that includes magnetic saturation effects. 

As pointed out in [38] , many of the previous AMB control techniques are 
based on the linearized electromechanical system. For example, Matsumura 
and Yashimoto [29] designed an optimal controller to regulate the rotor 
position. In [30], Mohamed and Emad used Q-parameterization theory to 
stabilize the rotor position and evaluate noise rejection and robustness to 
parametric uncertainty. Mohamed and Busch-Vishniac illustrated how Q- 
parameterization theory could be used to autobalance the rotor of a vertical 
shaft AMB system in [31]. An adaptive forced balancing controller was 
developed in [3] which exhibited negligible effects on the bandwidth and 
the stability margin. The possible advantages or disadvantages of nonlinear 
control techniques for AMB applications were addressed in [13] and [38]. 
Specifically, in [13], Charara and Caron compared the unbalance rejection 
and energy saving of linear and nonlinear controllers considering linear 
and nonlinear models for AMBs while in [38], Smith and Weldon utilized 
input-output feedback linearization and sliding-smode control techniques to 
center the rotor in a set of magnetic bearings. In [36], a nonlinear tracking 
controller was developed for a 6-DOF active magnetic bearing system. For a 
review of the evolution of magnetic bearing hardware, the reader is referred 
to [6]. 
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4 

Robotic Systems 



4.1 Introduction 

In this chapter, several different robotic applications are examined. Given 
that a myriad of industrial applications require robots to perform repe- 
titious tasks (e.g., assembly, manipulation, inspection), the first robotic 
control application examined in this chapter the development of learning 
control methods that exploit the periodic nature of the robot dynamics 
to improve link position tracking performance. Some of the advantages of 
a learning-based controller over some other approaches include the ability 
to compensate for disturbances without high-frequency or high-gain feed- 
back terms and the ability to compensate for time-varying disturbances 
that can include time-varying parametric effects. In the first section of this 
chapter, we illustrate how a saturated learning-based estimate can be used 
to achieve asymptotic tracking in the presence of periodic nonlinear dis- 
turbances. Since the learning-based controller estimate is generated from 
a Lyapunov-based stability analysis, we also illustrate how additional con- 
trol terms can be integrated to compensate for nonperiodic components of 
the unknown dynamics. Specifically, a hybrid adaptive/learning controller 
is designed for the robot manipulator dynamics. Experimental results are 
provided to illustrate that the link position tracking performance of a ro- 
bot manipulator improves with each repetitive motion due to the mitigating 
action of the learning estimate. 
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In many industrial/manufacturing applications, a robot manipulator is 
required to make contact with the environment (e.g., contour following, 
grinding, scribing, deburring, and assembly-related tasks). In these appli- 
cations, interaction forces between the robot manipulator end-effector and 
the environment are generated that constrain motion. Motivated by the 
desire to precisely control both the motion and the interaction forces of a 
robot, in the second section of this chapter, an adaptive tracking controller 
is developed for constrained robot manipulators that ensures global asymp- 
totic position/force tracking performance despite parametric uncertainty in 
the robot manipulator. The control strategy is primarily based on the fact 
that the total degrees of freedom (denoted by n) for the position/force 
control problem can be partitioned into m position control objectives and 
k force control objectives (i.e., n = m -\- k). This decoupling is accom- 
plished by employing the reduced-order transformation of [42] to develop 
n dynamic equations which are used to develop the position and force 
controllers separately. Specifically, the open-loop dynamics for the filtered 
tracking error system are developed independently of the contact force. 
The filtered tracking error dynamics are then used to formulate an adap- 
tive position controller that achieves asymptotic position/ velocity tracking 
despite parametric uncertainty. Next, the n dynamic equations developed 
from the reduced-order transformation are combined to form k dynamic 
equations that allow the contact force to be written in terms of nonlin- 
ear, dynamic quantities that are functions of only position and velocity 
(i.e., the dependence on acceleration has been eliminated). The k dynamic 
equations are then rewritten in terms of an open-loop tracking error system 
which describes the trajectory of the integral of the force tracking error. 
A judicious arrangement of the dynamic terms and the multiplication by 
a matrix determinant term facilitates the linear parameterization^ of these 
k open-loop tracking error dynamic equations. The k dynamic equations 
are then used to design an adaptive force controller that achieves asymp- 
totic tracking of the integral of the force tracking error despite parametric 
uncertainty. Further analysis is then presented to illustrate that the actual 
force trajectory tracks the desired force trajectory. An extension is provided 
that also describes how the full-state feedback controller can be modified to 
eliminate the need for velocity measurements. Specifically, based on the ad- 
ditional constraint of output feedback, high-gain control terms are injected 
to damp out bounded state dependant disturbances. The use of high-gain 



^ We note that this technique for obtaining a linear parametrizable dynamic equation 
was first used in [40] for the control of flexible joint robots. 
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control terms coupled with higher-order nonlinearities of the constrained 
robot manipulator model results in a semi-global asymptotic tracking result 
for the output feedback case. Experimental results of the output feedback 
controller are presented to illustrate the controller’s performance. 

Based on advances in control and sensor technologies, new robotic ap- 
plications are being developed in which the robot is required to operate 
in unstructured environments. Based on the ability of camera systems to 
provide a passive noncontact sense of perception in unstructured environ- 
ments, many of these robotic applications have exploited camera-based 
vision systems to enable trajectory planning and control. In the third sec- 
tion of this chapter, a visual servoing control design is developed, in which 
visual information is embedded directly in the feedback loop of the control 
algorithm. By closing the feedback loop in the image space, the vision and 
robotic motion problems are fused together, resulting in a cohesive control 
problem. Following this line of reasoning, in the third section of this chapter 
the design of visual servoing controllers for a nonredundant planar robot 
manipulator with a fixed camera [23, 32] configuration is developed. Given 
different levels of modeling uncertainty for the system, two position tracking 
controllers are formulated which account for the nonlinear robot dynamics 
and compensate for parametric uncertainty associated with the robot para- 
meters and/or the camera calibration parameters. Provided that the initial 
orientation of the camera is in the interval (—90°, 90°), a global adaptive 
tracking controller is first developed that compensates for unknown camera 
calibration parameters given that the mechanical parameters are exactly 
known. Assuming the camera orientation is restricted to the same interval, 
an adaptive controller is then developed that compensates for parametric 
uncertainties throughout the entire robot-camera system while producing 
global asymptotic position tracking. The design of the example controllers 
is facilitated by the construction of a novel design matrix that premultiplies 
the uncalibrated camera matrix into a more suitable positive-definite sym- 
metric structure for use in the stability proofs. An extension is provided to 
illustrate how the fixed camera visual servoing controllers can be extended 
to incorporate redundant robot manipulators. Moreover, motivated by ap- 
plications that are not well suited to the fixed camera configuration, an 
adaptive controller is also developed for the camera-in-hand problem. 



4.2 Learning Control Applications 

Driven by the desire to exploit the repetitive nature of many robotic ap- 
plications, researchers have investigated a variety of learning-based con- 




152 



4. Robotic Systems 



trollers. Typically, these controllers are characterized by the use of a stan- 
dard repetitive update law as the core part of the controller. However, to 
ensure that the stability analysis validates the proposed results, some re- 
searchers have investigated the use of additional rules or complex modifica- 
tions to the standard repetitive update law that inject additional complex- 
ity in the control design. As demonstrated in this section, these additional 
rules and additional complexity injected into the stability analysis are not 
necessary for the development of learning controllers. For example, consider 
the following simple closed-loop system 

X = —X + (p{t) — (p (t) (4-1) 

where x{t) E R is a tracking error signal, (f{t) eR. is an unknown nonlinear 
function that is periodic with a known period T (i.e., (p{t — T) = (p{t))^ and 
(p{t) G M is a learning-based estimate of For the system given in (4.1), 
the standard repetitive update law is given by the following expression 

= (p{t -T) -E X. (4.2) 

With regard to the error system given in (4.1) and (4.2), Messner et al. 
noted that the techniques used in [43] could not be used to show that (p{t) E 
Coo if ^(0 is generated by (4.2). To address the boundedness problem 
associated with the standard repetitive update law, a heuristic approach 
would be to saturate the entire right-hand side of (4.2) as follows [48] 

(p{t) — sat {(jp {t -T) -\- x) , (4.3) 

and hence, guarantee that (p{t) E Coo (the function sat(-) in 4.3 is the 
standard linear piecewise bounded saturation function). Unfortunately, al- 
though it is well known how to apply a projection algorithm to the adap- 
tive estimates of a gradient adaptive update law and still accommodate a 
Lyapunov-based stability analysis, similar arguments cannot be made for 
the saturated update law given in (4.3), and hence, it is not clear how the 
stability of the system is affected. Another approach to ensure the bound- 
edness of the update law is to saturate the standard repetitive update law 
as follows [20] 

(p(t) = sat {(p {t — T)) -h X. (4.4) 

Based on the structure of the repetitive update law given in (4.4), a 
Lyapunov-based approach is used in this section to (i) incorporate the sat- 
uration function in (4.4) in the stability analysis, (ii) prove that x{t) is 
forced asymptotically to zero, and (hi) show that (p{t) E Coo- To illus- 
trate the generality of the learning- based update law given by (4.4), we 
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illustrate how the update law can be used to force the origin of a gen- 
eral error system with a nonlinear periodic disturbance to achieve global 
asymptotic tracking. Moreover, to illustrate the fact that other Lyapunov- 
based techniques can be exploited in tandem with the repetitive update law 
to compensate for additional disturbances that are not periodic, a hybrid 
adaptive/repetitive learning scheme is designed to achieve global asymp- 
totic link position tracking for a robot manipulator. In comparison with 
several other results found in the literature, the learning-based controllers 
developed in this section (i) utilize standard Lyapunov-based techniques 
(hence, other Lyapunov-based tools can be easily incorporated), (ii) can 
be analyzed through a straightforward stability analysis, (iii) utilize a sim- 
ple modification of the standard repetitive update law as opposed to the 
use of a multiple-step process or menu, and (iv) are continuously updated 
during the transient response (versus during the steady state), and hence, 
facilitate improved transient response. 

4.2.1 General Problem 

To illustrate the generality of the learning control scheme developed in this 
section, we first examine the following error dynamics [43] 

e = f (t,e) -h B (t, e) [w{t) - w (t)j (4.5) 

where e{t) G is an error vector, w{t) G is an unknown nonlinear 
function, w(t) G is a subsequently designed learning-based estimate 
of w{t), and the auxiliary functions f{t,e) G and B(t^e) G are 

bounded provided e{t) is bounded. To facilitate the subsequent develop- 
ment, the following assumptions are made regarding the error dynamics of 
(4.5). 

Assumption 4.1: Asymptotic Stability 

The origin of the error system e(t) = 0 is uniformly asymptotically stable 
for 

e = /(i,e); (4.6) 

furthermore, there exists a first-order differentiable positive-definite func- 
tion Vi(e,t) G R, a positive-definite symmetric matrix Q(t) G R’^^'^, and a 
known matrix R{t) G R^^"^ such that 

Vi < —e^Qe + e^R [w — w] . (4.7) 

Assumption 4.2: Periodicity and Boundedness 
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The unknown nonlinear function w{t) is periodic with a known period 
T; hence, 

w{t — T)=w{t). (4-8) 

Furthermore, we assume that an upper bound for the unknown function 
w{t) can be formulated as follows 

\'^i\ ^ Pi for 2 = 1,2, ...,m (4.9) 

where ^2 ... /?^ ] G is a vector of known positive bound- 

ing constants. 

Control Objective 

The control objective for the general problem given in (4.5) is to design a 
learning-based estimate w (t) such that 

lim e(t) = 0 (4-10) 

t—*oo 

for any bounded initial condition denoted by e(0). To quantify the mis- 
match between the learning-based estimate and w (t), we define an estima- 
tion error term, denoted by w {t) E as follows 

w{t) = w{t) — w{t). (4.11) 



Learning-Based Control 

Based on the error system given in (4.5) and the subsequent stability analy- 
sis, we design the learning-based estimate w (t) as follows^ 

w{t) = satp {w {t — T)) + keR^ e (4.12) 



where /cg G R is a positive constant control gain, and sat/^ (•) G is a 
vector function whose elements are defined as follows 



sat^i (^i) 






sgn 



for \ii\ < Pi 
for > Pi 



G R,2 = 1,2, ...,m 



(4.13) 

where P^ represent the elements of P defined in (4.9), and sgn(-) denotes the 
standard signum function. From the definition of sat^ (•) given in (4.13), 
the following inequality can be obtained (see Lemma B.13 of Appendix B) 



(^li - i2if > (sat/3i (^li) - sat/5i 

< Pi,^2i € K,* = 



(4.14) 



^Note that the learning-based estimate given in (4.12) has the same structure as 
(4.4). 
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Based on (4.8), (4.9), and (4.13), the following relationship can be formu- 
lated 

w{t) — satp {w{t)) — sat/3 {w{t — T)) ; (4-15) 

hence, after substituting (4.12) and (4.15) into (4.11) for w{t) and w{t), 
respectively, the following expression can be developed for w(t) 

w{t) — sat/5 {w{t — T)) — sat/3 {w {t — T)) — e. (4.16) 

Remark 4.1 In the subsequent stability analysis^ we exploit the fact that 
the learning-based feedforward term given in 'Is composed of q sat- 

uration function. That is, based on the structure of (4- 12), we exploit the 
fact that w{t) G £oo provided e{t) G Coo- 

Stability Analysis 

Given the learning-based estimate in (4.12), the stability of the error system 
given in (4.5) can now be examined through the following theorem. 

Theorem 4.1 The learning-based estimate defined in (4-12) ensures that 

lim e{t) = 0 (4-17) 

t—^oo 

for any bounded initial condition denoted by e(0). 

Proof: To prove Theorem 4.1, a nonnegative function T^(t,e,t5) G M is 
defined as follows 

^ i Lr (4.18) 

• [sat^ (u;(r)) — sat^ (r^ (r))]) dr 

where Vi(t, e) is described in Assumption 4.1. After taking the time deriv- 
ative of (4.18), the following expression is obtained 

V2 < —e^Qe -h e^Rw 

1 T 

[sat/3 (w(t)) - sat/3 {w (t))] [sat/3 {w{t)) - sat^ {w (t))] 

~We ~ ~ ^ 

• [sat^ {w{t — T)) — sat/3 (^w {t — T))]) 

(4.19) 

where (4.7) and (4.11) were utilized. After using (4.16), the expression given 
in (4.19) can be rewritten as follows 

V 2 < —e^Qe e^Rw — (lo -f keR^ e)^ (w -f keR^ e) 

1 r ^ T 

[sat^ (w{t)) - Sditp {w (t))] [sat/3 - sat^ {w (t))] . 

(4.20) 
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After performing some simple algebraic operations, (4.20) can be further 
simplified as follows 

^2< -e^ (g+^i?/?^)e 

(w'^w - [sat^ - sat/j (w (i))]^ 

• [sat^ {u>{t)) - sat /3 {w (t))]) 

Finally, (4.9), (4.11), and (4.14) can be utilized to simplify (4.21) as shown 
below 

V 2 < -e'^Qe. (4.22) 

Based on (4.18), (4.22), and the fact that Q{t) is a positive-definite 
symmetric matrix, it is clear that e(t) G £2 H £ 00 • Since e(^) G £ 00 , we 
can use (4.5), (4.12), (4.13), and (4.16) to prove that w{t), u’(t), /(£e), 
B{t,e) G £oo- Given that w{t), w{t), f{t,e), B{t,e) G £005 h is clear 
from (4.5) that e(t) G £ 00 ? and hence, e(t) is uniformly continuous. Since 
e{t) G £2n£oo and is uniformly continuous, Barbalat’s Lemma (see Lemma 
A. 16 of Appendix A) can now be invoked to prove (4.17). □ 

4.2.2 Robot Control Problem 

The control design in the previous section exploited the fact that the 
unknown nonlinear dynamics were periodic with a known period. Unfor- 
tunately, some robotic systems may not adhere to the ideal assumption 
that all of the unknown nonlinear dynamics are entirely periodic. Since 
the learning-based feedforward term developed in the previous section is 
generated from a straightforward Lyapunov-based stability analysis, other 
Lyapunov-based control design techniques can be used to develop hybrid 
control schemes that used learning-based feedforward terms to compen- 
sate for periodic dynamics, and other Lyapunov-based approaches (e.g., 
adaptive-based feedforward terms) can be used to compensate for nonperi- 
odic dynamics. To illustrate this point, a hybrid adaptive/learning control 
scheme is developed for an n-rigid link revolute direct-drive robot manipu- 
lator in the following sections. 

Dynamic Model 

The dynamic model for a n-rigid link revolute direct-drive robot is assumed 
to have the following form [50] 

M {q)q + Vm{q, q)q-\- G{q) + Fdq + FsSgn{q) = r 



(4.23) 
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where q{t), q{t), q(t) G denote the link position, velocity, and acceler- 
ation vectors, respectively, M{q) G represents the link inertia ma- 
trix, ^ represents centripetal-Coriolis matrix, G{q) G E’^ 

represents the gravity effects. Fa € E^^^ is the constant diagonal positive- 
definite viscous friction coefficient matrix, Fg G E^^'^ is a constant diagonal 
positive-definite matrix composed of static friction coefficients, sgn{q) de- 
notes the vector composed of the standard signum function applied to each 
link position, and r{t) G E’^ represents the torque input vector. With re- 
gard to the dynamics given in (4.23), the standard assumption, that all of 
the terms on the left-hand side of (4.23) are bounded provided g(t), q{t), 
and q{t) are bounded, is made. 

The dynamic system given in (4.23) exhibits the following properties that 
are utilized in the subsequent control development and stability analysis. 

Property 4.1: Symmetric and Positive-Definite Inertia Matrix 

The inertia matrix is symmetric positive-definite and satisfies the follow- 
ing inequalities 



mi ll^f < < m2 ||^||' G M" (4.24) 

where mi, m 2 G E are known positive constants, and H-H denotes the 
standard Euclidean norm. 

Property 4.2: Skew-Symmetry 

The inertia and centripetal-Coriolis matrices satisfy the following skew- 
symmetric relationship 

Q M(g) - Vm{q, g)) e = 0 Ve e R" (4.25) 

where M (q) denotes the time derivative of the inertia matrix. 

Property 4.3: Bounding Inequalities 

The norm of the centripetal-Coriolis, gravity, and viscous friction terms 
of (4.23) can be upper bounded as follows 

l|Kn(g>g)llloc<Ccll|gil i|G(g)||<Cg ll^)i|lioo < 0^ (4.26) 

where CcIj Cp? C/d ^ denote known positive bounding constants, and 
iMIioo the induced infinity-norm of a matrix. 
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Property 4.4: Linearity in the Static Friction Parameters 

The static friction terms given in (4.23) can be linear parameterized as 
follows 

Ys{q)es = FsSgn{q) (4.27) 

where 6s G contains the unknown, constant static friction coefficients, 
and the regression matrix Ys{q) £ R’^^^ contains known functions of the 
link velocity. 

Control Objective 

The objective of this section is to design a global link position tracking 
controller despite parametric uncertainty in the dynamic model given in 

(4.23) . The control objective is based on the assumption that q (t) and q (t) 
are measurable. To quantify this objective, the link position tracking error, 
denoted by e{t) G R’^, is defined as follows 

e = Qd-q (4.28) 

where the desired link position qd{i) € M" and its first two time derivatives 
are assumed to be bounded periodic functions of time with a known period 
T such that 

qd{t) = qd{t - T) qd{t) = qd(t - T) qdit) = qd(t - T). (4.29) 

Control Development 

To facilitate the subsequent control development and stability analysis, the 
order of the dynamic expression given in (4.23) is reduced by defining a 
filtered tracking error variable, denoted by r{t) G R’^, as follows 

r = e -f oe (4.30) 

where a G R is a positive constant control gain. After taking the time 
derivative of (4.30), premultiplying the resulting expression by M{q), using 

(4.23) and (4.28), and then performing some algebraic manipulation, the 
following expression can be obtained 

Mr = -Vmr -\-Wr Yx + YsOs - r (4.31) 

where the auxiliary expressions Wr{t)^x{^) ^ ^re defined as follows 

Wr = M{qd)qd H- Vm{qd, qd)qd + G{qd) -f Fdqd (4.32) 

X = M{q) {qd + ae) -f Vm{q, q) {qd + ae) + G{q) -f Fdq - Wr- (4.33) 
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By exploiting Properties 4.1 and 4.3 and then using (4.28) and (4.30), the 
results given in [47] can be used to prove that 

11x11 <p(l| 2 ll)lkll (4.34) 

where the auxiliary signal z{t) G is defined as follows 

z{t)=[e^{t) r^(t) (4.35) 

and yo (•) G M is a known positive bounding function. Furthermore, based 
on the expression given in (4.32) and the boundedness assumptions with 
regard to the robot dynamics and the desired trajectory, it is clear that 

\'^ri\ ^ Pri for 2 = 1, 2, ...,n (4.36) 

where ..., P^^ ] G is a vector of known positive bounding 

constants. 

Motivated by the open-loop error system in (4.31) and the subsequent 
stability analysis, we design the following hybrid adaptive/learning con- 
troller 

T = kr + knP^ (|| 2 :||) r + e -h -f- YsOs- (4.37) 

In the controller given in (4.37), /c, G R are positive constant control 
gains, Wr{t) G R^ is generated according to the following learning-based 
algorithm 



Wr{t) = SSitp^{Wr{t — T)) + kiv, (4.38) 

0s(t) G R’^ is generated according to the following gradient update law 

es{t) = rsY,^r, (4.39) 

and Ys{q), p(-) were defined in (4.27) and (4.34), respectively. For the 
learning-based update law given in (4.38), C R denotes a positive con- 
stant control gain, and sat^^ (•) is defined in the same manner as in (4.13). 
For the adaptive gradient update law given in (4.39), F^ G is a con- 

stant diagonal positive-definite adaptation gain matrix. 

To develop the closed-loop error system for r(t), we substitute (4.37) into 
(4.31) to obtain the following expression 

Mr = -Vmr -kr - e + Ysds -\-Wr + x~ ^nP^ (H^^H) r (4.40) 

where the parameter estimation error vector, denoted by 0s (t) G R^, is 
defined as follows 



9s = 0s- 0 . 



( 4 . 41 ) 
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and Wr{t) G is a learning estimation error signal defined as follows 

Wr = Wr — Wr- (4.42) 

In a similar manner as in (4.15), the expressions introduced in (4.29), (4.32), 
(4.36), and the fact that sat/3r(-) is defined in the same manner as in (4.13), 
can be used to develop the following relationship 

Wr(t) = SSitpr ('^r(O) = Sat^^ (Wr(t — T)) . (4-43) 

Thus, after substituting (4.38) and (4.43) into (4.42) for Wr(t) and Wr{t)^ 
respectively, the following expression can be developed for Wr{i) 

Wr = saipr — T)) — sa,ti3^{wr{t — T)) — kir. (4.44) 

Remark 4.2 As in the stability analysis for Theorem 4- i, the fact that the 
learning-based feedforward term given in (4.38) is composed of a saturation 
function is exploited. That is, from the structure of (4-38), it is evident that 
Writ) G Coo provided r{t) G £oo- 

Stability Analysis 

The stability of the hybrid adapt ive/learning controller given in (4.37), 
(4.38), and (4.39) can now be examined through the following theorem. 

Theorem 4.2 The proposed hybrid adaptive /learning controller given in 
(4-37-4-39) ensures global asymptotic link position tracking in the sense 
that 

lim eU) = 0 (4.45) 

t—^oo 

where the control gains a, k, kn^ and ki introduced in (4-30), (4-37), and 
(4‘38) are selected to satisfy the following sufficient condition 

+ (4.46) 

Proof: To prove Theorem 4.2, we define a nonnegative function V{t) G M 
as follows 

• [sat/3r {wrir)) — ssitpr i'dbr ('t))] dr. 
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After taking the time derivative of (4.47) and then utilizing (4.25), (4.30), 
(4.39), and (4.40), the following expression can be obtained 

V = {r — ae) + {^-kr - e - knp^ r + + Wr + x) 



^ [satpr (Wr{t)) 



SHtpr {u>r (i))]'' 



• [sat/3r ('^r(O) “ sat/3r i'^r (0)] 

~^L ~ ~ ~ 



• [sat/5r {Wr{t — T)) — Sat/^^ {Wr {t — T))] . 

(4.48) 

After utilizing (4.34), (4.36), (4.44), and then simplifying the resulting ex- 
pression, we can rewrite (4.48) as follows 



V < —ae^e — kr^r -f r^Wr + 



- Kp^ 



2 



1 T 

“ 7^ (^^r + ^Lt) {Wr -f kiv) 

Zki 

1 T 

+ ^ [sat/3^ {Wr{t)) - Sat/3^ {Wr (t))] 

• [sat/3r i'^r{t)) — Sat/3r (f^r (^))] • 

(4.49) 

After expanding the second line of (4.49) and then cancelling common 
terms, the following expression can be obtained 



V < —ae^e — { k ^ ] r^r -h 



pdklDINI \\r\\-KpH\\z\\)\\rf 



1 




— [sat^^ {Wr(i)) — sat^r (f^r (0)]^ 



• [sat/3r {Wr{t)) — Sat/3r {Wr (t))]] . 



(4.50) 

By exploiting the property given in (4.14), completing the square on the 
bracketed term in the first line of (4.50) (or by invoking the nonlinear 
damping tool given in Lemma A. 17 of Appendix A), and then utilizing 
the definition of z{t) given in (4.35), the expression given in (4.50) can be 
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simplified as follows 

(4,51) 

Based on (4.35), (4.46), (4.47), and (4.51), we can now prove that e(^), 
r{t) G £2 n £ 00 • Based on the fact that r{t) G Coo, we can utilize (4.30), 
(4.38), and (4.44) to prove that Wr{t), Wr{t), e{t) G Coo, and hence, e{t) is 
uniformly continuous. Since e{t) G £2 H Coo and is uniformly continuous. 
Lemma A. 16 of Appendix A can now be invoked to prove (4.45). □ 

Remsirk 4.3 One of the advantages of the saturated learning-based feed- 
forward term is that it is developed through Lyapunov-based techniques. 
By utilizing Lyapunov-based design and analysis techniques, the bound- 
edness of the feedforward term can be proven in a straightforward man- 
ner (see Remark f.2), and the ability to utilize additional Lyapunov-based 
techniques to augment the control design (as in the example of the hybrid 
adaptive /learning controller) is facilitated. These traits are in contrast to 
learning-based designs in which additional analysis is required to examine 
the boundedness of the feedforward terms and the structure is less amenable 
to the incorporation of additional control elements (e.g., an adaptive control 
component). 



4.2.3 Experimental Setup and Results 



To illustrate the performance of the previous learning-based controller, the 
following controller^ was implemented on an Integrated Motion Inc. (IMI) 
two-link direct-drive planar robot manipulator 

T = kr Wr (4.52) 



where r{t) was defined in (4.30), k is given in (4.37), and Wr{t) is generated 
according to (4.38). The dynamic model for the IMI robot manipulator can 
be formulated as follows [19] 



Tl 

T2 



Pl+2p3C2 P 2 +P 3 C 2 



+ 






P2 + P 3 C 2 
-P3S2Q2 
P3S2Q1 



P2 

-P3S2{qi +( 12 ) 
0 



Qi 

Q2 



qi 

q2 



(4.53) 



fdi 0 


' qi ' 


1 


' fsl o' 


■ sgn(9i) ■ 


0 fd2 


. ^2 




. 0 fs2 . 


sgn(g2) . 



^To emphasize the effects of the learning-based feedforward control term, the non- 
linear damping term and the adaptive feedforward term utilized in (4.37) were omitted 
from the experimental trials. 
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where Pi == 3.473 [kg-m^],P 2 == 0.193 [kg-m^],P 3 = 0.242 [kg-m^], fdi == 5.3 
[Nm-sec], fd 2 = l-l [Nm-sec], fsi = 8.45 [Nm], fs 2 = 2.35 [Nm], sgn(-) 
denotes the standard signum function, C 2 =cos(g 2 )j Q-nd S 2 — sin(g 2 )- A Pen- 
tium 266 [MHz] PC with the real-time extension of the Linux operating 
system (RT-Linux) hosted the control algorithm. A Matlab/Simuhnk envi- 
ronment with the Real-Time Linux Target [62] for RT-Linux was used to 
implement the controller. The Servo-To-Go I/O board provided for data 
transfer between the computer subsystem and the robot at a rate of 1 [kHz] . 





FIGURE 4.1. Periodic desired trajectory. 



The experiment was performed using the following periodic desired po- 
sition trajectory (see Figure 4.1) 



’ Qdi{t) ' 




(0.8 + 0.2sin(0.5t))sin(0.5sin(0.5t)) (l — exp (— 0.6t^)) 


. Qd2{t) 




(0.6 + 0.2sin(0.5t)) sin (0.5sin(0.5t)) (l — exp (— 0.6t^)) 



[rad] 

(4.54) 



where the exponential term was included to provide a “smooth-start” to the 
system. After a tuning process, the control gains were selected as follows 

k = diag {40, 12} a = diag (20, 14} kL = diag (30, 10} (4.55) 

where diag{-} denotes the diagonal elements of a matrix. Note that in 
previous sections, the control gains /c,a, and ki are defined as scalars for 
simplicity, whereas in (4.55), the control gains are selected as diagonal 
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FIGURE 4.4. Learning-based feedforward component of the control input. 

matrices to facilitate the “tuning” process. The link position tracking errors 
are depicted in Figure 4.2. The results given in Figure 4.2 illustrate that 
the tracking error reduces after each period of the desired trajectory. The 
control torque input for each link motor is shown in Figure 4.3, and the 
feedforward learning component of the controller is given in Figure 4.4. 



4.3 Position and Force Control Applications 

As described in the introduction, many industrial applications often require 
that a robot apply forces to the environment. When a robot is in contact 
with the environment, rigid constraints are imposed on the robot motion. 
Since robots are typically designed with the capability of exerting large 
forces that have the potential to be destructive to the robot and/or the 
environment, precise control of both the position and the forces exerted by 
the robot is well motivated. Adaptive position/force tracking controllers are 
developed in this section for robot manipulators during constrained motion. 
Specifically, we prove that global asymptotic position/force tracking can be 
obtained despite parametric uncertainty in the mechanical dynamics. An 
extension is also provided that illustrates how a high-pass filter can be con- 
structed to facilitate the development of an adaptive position/force tracking 
controller when link velocity measurements are not available (output feed- 
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back). Experimental results are provided to demonstrate the performance 
of the developed output feedback controller. 



4.3.1 System Model 

In this section, the kinematic and dynamic models of a rigid-link robot 
are developed. Based on the fact that the control objective is focused on 
position/force tracking when the robot is in contact with the environment, 
motion constraint equations are also developed. 



Kinematic Model 



Given an open set Oi C and a function'^ H G C^(Oi), H : 0\ 
the forward kinematic model that relates the task space coordinates, 
denoted by x{t) G of a nonredundant robot manipulator (i.e., n < 6) 
to the joint space variables, denoted by q(t) G Oi, can be developed as 
follows 

x=^H{q). (4.56) 

By taking the time derivative of (4.56), the time derivative of the task 
space coordinates can be related to the time derivative of the joint space 
variables as follows 

x = Jq (4.57) 



where J{q) G 
follows 



represents the manipulator Jacobian and is defined as 



J = 



dH 
dq ■ 



(4.58) 



By defining a function h G C^{H{Oi)), h : H{Oi) Oi, the joint space 
variables and the task space coordinates can also be related through the 
following inverse kinematic model 



q - h{H{q)) = h{x) Wx G H{Oi). (4.59) 



As described previously, motivation exists to develop a reduced-order 
dynamic model. To facilitate the development of the reduced-order model, 
the task space variables are partitioned as follows 

x{t) — [x\ ^2 (4.60) 

where xi{t) G R^, X 2 {t) G R^, and m-\-k = n. With regard to the manipu- 
lator Jacobian, it is assumed that J(x) G C^{Oi) and J~^{x) G C‘^{H(Oi)). 



'^The notation / G is utilized to indicate that / is order differentiable. 
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Moreover, the inverse of the manipulator Jacobian matrix is assumed to 
exist (i.e., all kinematic singularities can be avoided) and is given by the 
following expression 



j-i- 



dh 

dx 



(4.61) 



Constraint Equations 

As described previously, this section is focused on the control of a rigid 
robot manipulator when it comes in contact with a rigid environment. 
When in contact with the environment, the motion of the robot manipula- 
tor is constrained by interaction forces. Specifically, the interaction forces 
(also referred to as constraint forces) between the robot manipulator and 
the environment reduce the degrees of freedom of the manipulator. As a 
means of incorporating the effects of the interaction forces in the overall 
control design, a constraint model is formulated. To facilitate the subse- 
quent control development and stability analysis, we assume that the ro- 
bot manipulator end-effector is always on the constraint surface during 
closed-loop operation and that the known constraints are frictionless^ and 
holonomic. Specifically, an open set O 2 C H{Oi) and a known function 
0 G C^(iJ(Oi)), 0 : H{Oi) R^, are defined where 0 (x) is assumed to 
satisfy the following holonomic constraint 

e = 0k Vx G O 2 (4.62) 



where the notation 0^ denotes a ^ x 1 vector of zeros for all C ^ 
time derivative of 0(x) can be expressed by the following relationship 



© == Ax 



(4.63) 



where the Jacobian matrix A{x) G R^^^ is a function that has full 
rank (i.e., the k columns of A{x) are linearly independent) and is defined 
as follows 



a© 



dx 



(4.64) 



To facilitate the development of the subsequent reduced-order dynamic 
model, the Jacobian matrix A{x) of (4.64) is partitioned as follows 



[ E n ] 



(4.65) 



^From a practical standpoint, the constraint forces will be subject to surface friction 
effects; however, these effects can simply be treated as a disturbance since friction is a 
function of the applied normal force [39]. 
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where the partitioned matrices E(x) G and n(a:) G 

as follows 

dxi dx2 



cxk 



are defined 



(4.66) 



where X 2 {t) is assumed to be selected such that II(x) has full rank, and 
hence, is invertible. Based on the previous development, the Implicit Func- 
tion Theorem (see Lemma A. 2 of Appendix A) can be used to define an 
open set O3 C and a unique function Q G C^{Os)^ : O3 ^ R^, 

such that 

fi(xi) = X 2 Q{xi,ft) = Ofc ^xi G O 3 . (4.67) 

Since A(x) is partitioned as in (4.65), the expression given in (4.63) can be 
rewritten as follows 



- , de de an \ . 

dxi dx2 dxi ) 



(E + IIA) x\ — Ofc> 



(4.68) 



where E(x) and II(a:) are defined in (4.66) and A(x) G 
function that is defined as follows 



IS a 






A = 



an 

axi 



(4.69) 



Remark 4.4 Prom a heuristic standpoint, the assumption that the inter- 
action forces are frictionless allows the number of forces that must be con- 
trolled to be reduced. By assuming that the interaction forces impose a 
holonomic constraint, the manipulator motion can be shown to belong to 
an invariant manifold C G R^^ as follows [39, 42] 



C = {(x, x) : Q{x) = Ofc, A{x)x = 0} . 



(4.70) 



As stated in [42], C is singular; therefore, the order of the motion dynamics 
can also be reduced (see [39] for a further heuristic discussion on how the 
position and force variables have been reduced in dimension). 



Reduced-Order Dynamic Model 

The full-order dynamic model for an n-rigid link direct-drive revolute nonre- 
dundant robot is assumed to have the following form [50] 

Mq + VmQ 4- -h / == r (4.71) 

where q{t), q(t), q(t) G R’^ denote the joint position, velocity, and accel- 
eration vectors, respectively, M{q) G is the inertia matrix, Vm{(lA) 
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^ I^nxn is centripetal-Coriolis matrix, N(q^q) G contains the gravity 
and friction vectors, f{t) G R’^ describes the joint space end-effector forces 
exerted on the environment by the robot manipulator, and r{t) G R^ rep- 
resents the input torque vector. 

To facilitate the subsequent position/force tracking control objective, it 
is common to transform the robot joint space dynamics, given in (4.71), 
into the task space [50]. This coordinate transformation allows the robot 
end-effector forces of (4.71) to be written as task space forces, which is 
the most common way of specifying a force control problem. Specifically, 
after premultiplying (4.71) by the transpose of the inverse Jacobian given in 
(4.61) and utilizing the kinematic relationship given in (4.57), the following 
task space dynamic model can be developed 

M*x + V^x + N* + J-'^f = T* (4.72) 

where x{t) is given in (4.56), and M*{x) € V^{x,x) € R"^", 

N*{x,x) € R", and T*{t) e R” are defined as follows 

M* = y;; = {y^ - j-^ (4.73) 

N* = J-'^N T* = J-^T. 

The dynamic equation given in (4.72) has n degrees of freedom in the ab- 
sence of motion constraints. However, given the k frictionless and holonomic 
motion constraints in (4.62), the resulting degrees of freedom are reduced 
to n — k. Moreover, although there are only n control inputs, there are n + k 
variables to control (i.e., n position control variables and k force control 
variables). To reduce the number of states of the constrained robot system, 
a reduced-order transformation [42] variable u{x) = [ u[(x) U 2 {x) ] G 

R^ can be defined as follows 




where xi(t), X 2 {t) were defined in (4.60), fl(x) is defined in (4.67), and 
A(a:) is defined in (4.69). Based on (4.69), (4.74), and (4.75), the following 
relationship can be developed 



X = Tu. 



(4.76) 
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After premultiplying (4.72) by T^(a:) and utilizing (4.76), the constrained 
robot manipulator dynamics can written as follows 

Mil + VmU + N + A^X = f (4.77) 

where M{u) £ V^{u,u) £ R”''", N(u,u) £ R", A(u) £ and 

f{t) £ R" are defined as follows® 

M = T'^M*T Vm = T'^ (m*T + V^t'J (4.78) 

N = T'^N* A = AT t = r^r* 

where A(x) was defined in (4.64), and the generalized force multipliers 
X(t) e satisfy the following relationship [42] 

J-Tf = A'^X (4.79) 



where J{q) was defined in (4.58), and f{t) is given in (4.71). Based on 
(4.65), (4.75), and (4.78), A{u) can be written in the following partitioned 
form 

A = [ Ofcxm n ] . (4.80) 

Furthermore, based on the definition of f2(x) given in (4.67) and the def- 
inition of U 2 {t) given in (4.74), the dynamics for U 2 {t) can be reduced as 
follows 

U2 = ii2 = ^2 — Ofc (4-81) 

on the constraint surface. Given the partition of (4.74) and the relationships 
in (4.80) and (4.81), the dynamic model given in (4.77) can be expressed 
in the following reduced-order partitioned form 



ri 




■ Mii(ui) 


Mi2(ui) 


■ til 


^2 . 




M2i(ui) 


M22{ui) 


. Ofc . 



^mll {Ul , ill) 
Vm2l{ui,Ui) 



^ml2 (^1 5 ill ) 
Vm22{ui,ill) 





ill 




. Ofc . 



Ni(ui,Ui) 

N2{ui,iii) 




X. 



(4.82) 



^We make the standard assumption that N{u,u), and (u) of (4.77) 

and the first time derivatives of these quantities are bounded provided that u{t), u{t), 
u{t) € Loq. In addition, we assume that M{u) of (4.77) and its first and second time 
derivatives are bounded provided that n(t), n(t), u{t) G Loo- 
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Property 4.5: Symmetric and Positive-Definite Inertia Matrix 

The inertia matrix is symmetric positive-definite and satisfies the follow- 
ing inequalities 

mi < m2 ll^ll' € M" (4.83) 

where mi, m 2 G M are known positive constants, and H-H denotes the 
standard Euclidean norm. 

Property 4.6: Skew-Symmetry 

The inertia and centripetal-Coriolis matrices satisfy the following skew- 
symmetric relationship 

= 0 (4.84) 

where M{q) denotes the time derivative of the inertia matrix. 

Property 4.7: Linearity in the Parameters 

The first m rows of the reduced dynamic model given in (4.82) can be 
linear parameterized as follows 

Yd0i = Mii{ucn)udi + Vmu{udi,udi)udi + Ni{udi,udi) (4.85) 

where 6 gMP contains the unknown constant mechanical parameters (e.g., 
friction coefficients and inertia-related quantities), Udi{t)^Udi{t)^Udi(t) G 
represent the desired position, velocity, and acceleration trajectories, 
respectively, and Yd{t) G represents a known regression matrix which 

is only a function of the desired motion trajectory and its time derivatives. 
It is assumed that upper bounds for Udi{t) and its first and second time 
derivatives can be formulated as follows 

||wdi(i)ll < Cdp l|wdi(^)ll < Cdv l|wcii(i)ll < Cda (4-86) 

where and (da ^ ^ known positive bounding constants. The 

determinant of the submatrix Mii(ui) defined in (4.82) can also be para- 
meterized as follows 



det (Mil (wi)) = h^{ui)em (4.87) 

where dm € contains the unknown constant parameters, h{ui) G is 
a known vector function, and det (•) denotes the determinant of a matrix. 
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Property 4.8: Convex Region 

To avoid singularities in the subsequent control law, a convex region can 
be defined [40] for the parameter vector 9m introduced in (4.87). Specifi- 
cally, the structure of (4.83) and (4.87) can be used to define the following 
relationship 

UHd < h'^(ui)0m < md(ui) (4.88) 

where G R is a known positive bounding constant, and md(-) G R is a 
known positive bounding function. Based on the parameterization of (4.87), 
a space H spanned by the vector function h{ui) can be defined as follows 

H = [v : V = h{ui)} . (4.89) 

A convex region A (see [40] for the proof of convexity of A) is also defined 
as follows 

A = {u : v^h > \/h G H] (4.90) 

where was given in (4.88). In addition, the following definitions con- 
cerning the region A and the subsequently designed parameter estimate 
vector 6m{i) ^ R^^ (i.e., the dynamic estimate of ^ A given in (4.87)) 
are provided as follows: int(A) denotes the interior of the region A, 9(A) 
denotes the boundary for the region A, 9^{t) G R^^ is a unit vector nor- 
mal to 9(A) at the point of intersection of the boundary surface 9(A) and 
^m(^) where the positive direction for 6^{t) is defined as pointing away 
from int(A) (note that 9^{t) is only defined for 6m{t) G 9(A)), P^(/x) is the 
component of the vector /x G R^^ that is tangent to 9(A) at the point of 
intersection of the boundary surface 9(A) and the vector 9m{t), and 

PH^^) - M - e (4.91) 

is the component of the vector /x G R^^ that is perpendicular to 9(A) at the 
point of intersection of the boundary surface 9(A) and the vector 9m (0- 

4.3.2 Control Objective 

The objective of this section is to enable the end-effector of a robot ma- 
nipulator to simultaneously track a desired task space position and force 
trajectory despite parametric uncertainty associated with the manipulator 
dynamic model given in (4.71). The control objective is based on the as- 
sumption that x{t)^ i{t), and A (t) are measurable. To quantify the task 
space position control objective, the position tracking error e (t) G R’^ is 
defined as follows 



e = Udi - ui 



(4.92) 
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where lii(t) and Udi{t) are defined in (4.74) and (4.85), respectively. To 
reduce the order of the subsequent error dynamics, a filtered tracking error 
r{t) e is defined as follows 



r = e -f ae (4.93) 

where a C R is a positive constant control gain. To quantify the force 
control objective, a force tracking error-like term e\{t) G R^ is defined as 
follows 

^x= [ (Ad(cr) - X(a)) da (4.94) 

Jo 

where A(t) was defined in (4.77) and Xd{t) € R^ represents the desired 
force trajectory. It is assumed that Xd{t) and its first time derivative are 
bounded. Based on (4.94), the time derivative of e\(t) is given by the 
following expression 

CA - Arf - A. (4.95) 

In the subsequent stability analysis, e\{t) and e\(t) are proved to be as- 
ymptotically driven to zero; hence, if e\ goes to zero, (4.95) can be used to 
prove that the mismatch between the actual and desired forces is driven to 
zero. 



4.3.3 Full-State Feedback Control 

Position Control Development 

To develop the open-loop error system for r(t), we take the time deriva- 
tive of (4.93), premultiply the resulting expression by Mu (ui), and then 
substitute (4.82) for Mn{ui)ui{t) to obtain the following expression 



Mur = -Vmiir -f Yi6i - n (4.96) 

where the time derivative of (4.92) and (4.93) were utilized and the linear 
parameterization yi(e, e, t)6i is defined as follows 

Yidi = MiiUdi + YmiiUdi + o^ (Miie -j- Vmiie) 4- A^i (4.97) 

where Yi (•) G R^^^ represents a known regression matrix, and 6i is given 
in (4.85). Based on the structure of (4.96) and the subsequent stability 
analysis, the following adaptive position tracking controller can be devel- 
oped 



n = Yi6i + kr 



(4.98) 
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where /c G M is a positive constant control gain, and Oi{t) G is a dynamic 
estimate for the unknown parameter vector 9i that is generated according 
to the following gradient update law 



ei=TY^r (4.99) 

where F G is a constant diagonal positive definite gain matrix. After 
substituting (4.98) into (4.96) for ti(^), the following closed-loop dynamics 
can be obtained 

Mur = -t4iir + Yi9i - kr (4.100) 

where the parameter estimation error ^i(^) G R^ is defined as follows 

9i =6>i -01. (4.101) 

Since the unknown parameter vector 0i is constant, the closed-loop error 
system for 9i{t) is obtained by taking the time derivative of (4.101) and 

substituting (4.99) for 9\ (t) as follows 

0i=-ryi^r. (4.102) 



Force Control Development 

To develop the open-loop error system for ex(t), the first m rows of (4.82) 
can be used to solve for ui{t) and the resulting expression substituted into 
the last k rows of (4.82) to obtain the following expression 



T2 = M2iMu (^1 - yrnllUl ~ M) + Vm2lUl + N2 + (4.103) 

After premultiplying (4.103) by det(Mii)n~^(x), the following expression 
is obtained 

det(Mii)A = — n~^M^ 2 iadj(Mii) (r i — VmiiUi — Ni) 

- det(Mii)n-^ {Vm2iui + N 2 ) T det(Mn)n-^f2 

(4.104) 

where adj(Mn) denotes the adjoint of Mn(ui). To obtain the open-loop 
force tracking error dynamics, (4.95) can be used to rewrite (4.104) as 
follows 



det(Mii)eA - 



ld(det (Mil)) 
2 dt 



+ 12^2 - det(Mii)n ^T2 



(4.105) 




4.3 Position and Force Control Applications 



175 



where the linear parameterization y2{e\,ui,ui^r^6i^t)62 is defined as fol- 
lows 

Y20^ = + n-^M 2 iadj(Mn) (ti - t^nui - N{) 

+ det(Mii)n~^ (^^21^1 d- N 2 ) -f det(Mii)Ad 

(4.106) 

where O2 6 denotes a vector of unknown constant parameters, l2(-) C 
R^xp2 jg ^ known regression matrix, and the bracketed term in (4.105) 
and (4.106) was added and subtracted to facilitate the subsequent control 
design and stability analysis. 

Given the open-loop force tracking error dynamics of (4.105), the follow- 
ing adaptive force controller can be designed 

T2 = (>^ 2 ^ 2 ) + n^—ex (4.107) 

h^9m ^ ^ md 

where k is the same positive control gain given in (4.98), h (ui) is defined 
in (4.87), 0m{t) is given in Property 4.8, 02{t) G R^^ is subsequently de- 
signed dynamic estimate for 62^ and is the positive constant defined in 
(4.88). After substituting f2(t) of (4.107) into (4.105) and then adding and 
subtracting l 2 (*)^ 2 (^) to the resulting expression, the following closed-loop 
force tracking error dynamics are obtained 

det(M„)e, = (det (M„)) ex +¥262 - 

~ (4.108) 

where the parameter estimation error terms 02(0 ^ 0m (0 ^ 

are defined as follows 

02 = 02 - 02 0m = 0m -0m. (4.109) 

Based on the subsequent stability analysis, the structure of (4.108), and 
Property 4.8, the parameter update laws for the unknown vectors 02 and 
Om are designed as follows 

02= ex (4.110) 

and 

{ ^ll if 6m € int(A) 

if 6m € 9(A) and < 0 

P,‘(Mi) if0™e9(A)andAtf^i>O (4-lH) 

dm{0) e int(A) 
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where Fi G is a positive definite diagonal matrix, and /Xj G 

defined as follows 



IS 



Ml 



-h 



^202 



eA* 



(4.112) 



Because 02 and 6m are constant vectors, the closed-loop dynamics for 02{t) 
and 6m{i) can be obtained by taking the time derivative of (4.109) and 
substituting (4.110) and (4.111) into the resulting expressions for 02{t) and 
0m{t)^ respectively, as follows 







h it) = -riy2^e^ 


(4.113) 


6m — ^ 


1 1 1 


if 6m ^ int(A) 

if 6m ^ d{A) and pj6^ <0 
if 6m ^ d{A) and pj6^> 0 


(4.114) 


Stability Analysis 






The stability of the adaptive position and force tracking controller given in 
(4.98) and (4.107), with the adaptive update laws given in (4.99), (4.110), 



and (4.111) can be examined through the following theorem. 

Theorem 4.3 The position controller of (4-98) and (4-99) and the force 
controller of (4-107), (4-110), and (4-111) ensure global asymptotic position 
and force tracking in the sense that 

lira e{t), exit), exit) =0. (4.115) 

t—^OO 

where e{t), exit), and ex{t) were defined in (4-92), (4-94), and (4-95), 
respectively. 



Proof: To prove Theorem 4.3, we define a nonnegative function V (t) G 
as follows 



v= + idet(Mii)eleA + '^1 



(4.116) 



After taking the time derivative of (4.116), substituting (4.100) and (4.108) 
for the closed- loop tracking error dynamics for r(t) and ej^(t), respectively, 
utilizing (4.83) and (4.88), the following simplified expression is obtained 



V < r^ 



(yi0i - fcr) 






uTh 

+¥262 - 

h 6 m 



(4.117) 



+02rr'^2 +fm 
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After substituting the closed-loop dynamics given in (4.102), (4.113), and 
(4.114) into (4.117) and cancelling common terms, the following expression 
can be obtained (see Lemma B.14 of Appendix B) 



V < —kr^r — ke^e\ 



(4.118) 



where (4.87) and (4.112) were utilized. 

The direct implication of (4.116) and (4.118) is that r(t), 6 i{t), 

02(t), and 6 m{t) C Coo ^nd that r{t), e\{t) G £ 2 - Hence, by invoking Lemma 
A. 13 of Appendix A, we can prove that e(^), e{t) G Coo- Based on the fact 
that 0, 01 , and 6 m are composed of constant bounded parameters and that 
^i(0j ^ 2 ( 0 ? ^m(0 C £005 (4.101) and (4.109) can be used to prove 

that 0i(t), 02(0) ^m(0 ^ ^oo- Since e(t), e(t), ^i(O) ^(0 ^ ^00 and 

'Wdi(O) ^di{t) G £005 the expressions in (4.92), (4.97), and (4.98) 
can be used to prove that ui{t), Ti (•), fi(t) G Coo- Given that 

Yi (•) G £005 all the terms on the right-hand side of (4.97) are bounded, 
and hence, (4.93), (4.99), and (4.100) can be utilized to prove that f(t), 

e(0, 61 (0 G Coo- Prom the fact that r{t) G Coo, (4.92) and (4.93) can be 
used to prove that Ui{t) G Coo- The expression in (4.80) and the fact that 
ui{t), ui(t), ui{t) G Coo can now be used to prove that ^^(u,?!), N{u,ii), 
A{u), H(a;), M{u) G Coo- The fact that ui{t), e\{t), H(a:), Li (•), 

Ti(0 G Coo and Xd{t) is assumed to be bounded, (4.106) can be used to 
prove that I 2 (*) ^ ^ 00 - From the previous boundedness arguments, the 
expressions in (4.103), (4.107), (4.108), (4.110) and the development in 

Lemma B.14 of Appendix B can be used to prove that ex{t), 62 (t), 

X{t) G Coo-^ Furthermore, from (4.112), it can be shown that /Xi(i), P^(/ii), 

G Coo] hence, (4.111) can be used to prove that 9m (i) G Coo- 
Having proved that r{t), ex{t) G £00 H £2 and r{t), ex(t) G Coo, Lemmas 
A. 15 and A. 16 of Appendix A can be invoked to prove that 

lim r{t), e(t), ex(t) = 0. (4.119) 

t — >00 

From (4.119), it is clear that the task space position control objective 
is satisfied. However, to prove that the force control objective is satisfied 
(i.e., to prove that X{t) tracks Xd{t)), we must now prove that ex(t) goes 



^Note that the only appearances of f \d{t)dt and / \{t)dt in (4.107), (4.110), and 
(4.111) are through the variable e\{t) which was shown to be bounded. Hence, it is 
not necessary to assume that J Xd{t)dt is bounded to ensure the boundedness of f 2 (t), 

62 (t), and dm {t). 
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to zero as indicated by (4.95). Note that e\(t) can be rewritten as 

'■* de\{a) 






- 

Jo 



da 



-da + C 



(4.120) 



where C G is a vector of integration constants. Based on (4.119), the 
expression given in (4.120) can be used to prove that 

'■* dex{a) 



lim 

t—*oo 



f 



da 



-da 



(4.121) 



exists and is finite. Moreover, based on the previous development, it can be 
shown that ex{t) G Coo (see Lemma B.15 in Appendix B), and hence, e\{t) 
is uniformly continuous. Given (4.121) and the fact that is uniformly 
continuous, the integral form of Barbalat’s Lemma (see Lemma A. 20 of 
Appendix A) can be invoked to prove that 



lim e\ = 0. 

t— ^oo 

Hence, the position and force control objectives are satisfied according to 
the result given in (4.115). □ 



4.3.4 Output Feedback Control 

The development given in Section 4.3.3 is based on the assumption that 
link position and velocity measurements are available. However, link veloc- 
ity measurements are usually not available in robotic applications due to 
the additional sensor cost. One popular method for obtaining position and 
velocity measurements without incorporating an additional sensor is to use 
the backwards difference algorithm in which the link velocity is numeri- 
cally calculated from the link position measurements. As described in [18], 
this approach is not theoretically satisfying and introduces noise into the 
system; hence, motivated by the desire to eliminate the need for velocity 
measurements, an output feedback extension of the previous position/force 
tracking result is developed in this section. 

Position Control Modifications 

Since link velocity (and hence e{t) and ui{t)) is now assumed to be unmea- 
surable, a filter can be constructed to generate a surrogate velocity tracking 
error signal. This filter can be thought of as a high-pass filter having as an 
input the position tracking error of (4.92) and producing as an output a 
pseudo- velocity tracking error signal. The filter is given by the following 
dynamic relationship [7] 

p = - {kp -hi) p+ {kp-^l)e p{0) = kpe(0) 



(4.122) 
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ef-—kpe-\-p (4.123) 

where e/(t) G is the output of the filter that will be used as a link 
velocity substitute, p{t) G is an auxiliary filter variable, and /cp G M is 
a filter gain selected as follows 

/Cp = ^ (1 + 2kn) (4.124) 

where mi G R is a known bounding constant for Mu{u) of (4.82) such that 

mi ll^lp < € R” (4.125) 

and /Cn € R is a positive nonlinear damping gain [36]. 

To further facilitate the output feedback design, the open-loop position 
tracking error system is developed in terms of the high-pass filter dynamics. 
Specifically, after taking the time derivative of (4.123) and substituting the 
right-hand side of (4.122) for p{t) the following expression is obtained 

Cf = -kp6 - (kp + l)p-\- [kp -I- 1) e. (4.126) 

After substituting (4.123) into (4.126) for p{t)^ the following open-loop 
position tracking error dynamics for e/(t) can be obtained 

e/ = —kpT] — 6/ + e (4.127) 

where the filtered tracking error variable 77 (t) G R’^ is defined as follows 

rj =z e Ef e. (4.128) 

The open-loop dynamics for rj{t) can be developed as follows [17] 

Mnf] = x-fi-h YdOi - kpMiip - VmiiV (4.129) 

where the state-dependent disturbance variable x('^i 5 ^) C R^ is 

defined as follows 

X = Miiildi + ymiiUdi Ni — Yd^i — 2Mii6f -}- Mutj + Vmii {^f Y ^) ? 

(4.130) 

and the linear parameterization Yd{udi,Udi,'Udi)Oi is given in (4.85). 

Based on the structure of (4.129), the following adaptive output feedback 
position tracking controller can be designed 

fi =Yd0i - kpCf + e (4.131) 

where kp was defined in (4.124), and 9i{t) G R^ of (4.99) is redesigned 
according to the following velocity independent gradient update law 

^i=ri [ Yj'{a){e{a)+ef{a))dcT + riYj'e-ri [ Yj'{a)e{a)da. 

Jo Jo 

(4.132) 
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Force Control Modifications 



To rewrite the open-loop force tracking error dynamics of (4.105) in a form 
that facilitates the development of a velocity independent controller, (4.95) 
can be used to rewrite (4.104) in the following form 

det(Mn)eA = -1 (det (Mn)) ^ ^ (4 ;^33) 

L at 



where Yy(ui,ui,ef , e;^) G is a state-dependent disturbance variable de- 
fined as follows 



Yv = 



ld{det (Mil)) 
2 dt 



e\ H- det(A4^ii)Aci — Yy6y 



+n ^M2iadj(Mii) (ti — — A/"!) 



(4.134) 



+ det(Mii)n ^ (Kn2i^i + ^ 2 ) j 

and the linear parameterization Yy{ui^ef ^e\^0^t)6y is defined as follows 
i a(det (Mil)) . 



Yy6y 



2 + det(Mii)Ad 

+n~^M2iadj(Mii) (fi - Vmii {ui,Udi)udi ~ Ni{ui,iidi)) 



det(Mii)n ^ (Vm2i {ui,Udi)udi + N2{ui,Udi)) 

(4.135) 

where 9y G denotes a vector of unknown constant parameters, and 
Yy{ui^ej ,ex,6) G R^^p"^ is a known regression matrix. It is important to 
note that the parameterization given in (4.135) has been constructed to 
avoid the use of velocity measurements by replacing the link velocity signal 
ui(t) with the desired link velocity Ud\{t). 

Given the open-loop force tracking error dynamics of (4.133), the adap- 
tive force controller given in (4.107) is redesigned as follows 

T2 = (^-^0 + n^ — SA (4.136) 

h^Om ^ ^ 

where mi is the positive bounding constant defined in (4.125) and m^ is 
the positive bounding constant defined in (4.88). In (4.136), 0y{t) G R^^ 
denotes a dynamic estimate for the unknown parameter vector Os that is 
generated according to the following gradient update law 



9y= TyVjex 



(4.137) 
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where Ty 6 is a constant diagonal positive definite gain matrix and 

9m{i) is designed in the same manner as in (4.111), where /i(t) of (4.112) 
is redefined as follows 






h'l'Oy 



\yX 






(4.138) 



After substituting T 2 {t) of (4.136) into (4.133), the following closed-loop 
force tracking error dynamics can be obtained 



det(Mu)eA ^ -\i (det (Mn)) + yX ~ 



hT'On 



(4.139) 



, fcpmidet(Mii)_ 

\ ^ V 

m.d 



where the parameterization of det(Mn) in (4.87) has been utilized, the 
parameter estimation error term 9y{t) € is defined as follows 



9y=9y-9 



V) 



(4.140) 



and 9m{t) is defined in (4.109). 



Remark 4.5 By adding and subtracting suitable terms to the right-hand 
side of (4-139) and (4-134), Lemma B.16 and Lemma B.17 of Appendix B 
can be invoked to construct the following inequality 



p{Qp,Cdv,CdaA\y\\) Ibll > max 




(4.141) 



where and were defined in (4-86), y{t) € 3 ?am+fc defined as 



y = 



T T T 

e^ ej T] 




(4.142) 



and p(-) G M is a positive nondecreasing function. 



Stability Analysis 

The stability of the adaptive output feedback position/force tracking con- 
troller given in (4.131), (4.132), (4.136), (4.137), and (4.111) with (4.138) 
can now be examined through the following theorem. 

Theorem 4.4 Given the position controller of (4-131) ^ the force controller 
of (4-136), and the parameter update laws of (4-132), (4-137), and (4-111) 
with (4-138), if kn of (4-124) is selected as follows 



^ P I Cdp 5 C di; 5 C da 5 ' 



/ A2 (m(0)) 

Ai 



K0)ll 



(4.143) 
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then 

lim l|3/(t)||=0 (4.144) 

t— ^OO 

where p(-) andy{t) were defined in (f.lfl) and ( 4 . 142 ), respectively, z{t) G 
defined as 

Z= ej T]’^ el 9^ 6^ , (4.145) 

Ai G R a positive bounding constant defined as 

Ai = ^ min {1, mi, m^, Amin {r^^} ,Amin {r^T^}} , (4.146) 

and \ 2 {ui) G R 25 a positive bounding function defined as follows 

A 2 (ui) = lmax{l,m2(lti),rn<i(ui),Amax ,Amax {Fn^}} ■ (4.147) 

The notations Amin {•} 0 ,'^d Amax {•} represent the minimum and maximum 
eigenvalues of a matrix, respectively. 



Proof: To prove Theorem 4.5, we define a nonnegative function V{t) £ 
as follows 

V = le^e + leje/ + + 1 det(Mn)eJeA 



where V(t) can be bounded as follows 

Ai||2/||'<Ai||z||2<l/<A2(ni)|k|i 



and y(t), z(t), Ai, and A 2 (ui) were defined in (4.142) and (4.145-4.147), 
respectively. After taking the time derivative of (4.148) and following a 
similar analysis as given in the proof for Theorem 4.3, the following upper 
bound can be obtained 



-Ikl 






kpmi ||eA|r - kpmi Hr/H 



(4.150) 



lxii + iieAii n . 



After substituting (4.124) and (4.141) into (4.150), the following upper 
bound can be formulated 

-\\ef-\\ef\f-\\exf-\\vf 



+ P(Cdp, l|j/||) Ill/ll ll»?ll - 2fc„ Wvf 

+ P(Cdp,Cdv,C<ia- Ill/ll) ill/ll IIcaII -2kr,\\exf 



(4.151) 
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where y(t) was defined in (4.142). After invoking Lemma A. 17 of Appendix 
A, and utilizing (4.149), (4.151) can be upper bounded as follows 

1><- Ibir (4.152) 

To ensure that V{t) is negative semi-definite, the bracketed term in (4.152) 
must be positive; hence, the analysis to this point can be summarized by 
the following inequality 

V<-0\\yf for (4-153) 

where /? G M is a positive bounding constant. Provided the gain condition 
given in (4.153) is satisfied, V{t) will be negative semi-definite, and hence 

V{t) < V{z(0)) Vt > 0. (4.154) 

Based on (4.149) and (4.154), the following result can be obtained 

y < -P\\yf for \\m\\^ ■ 

(4.155) 

From (4.148) and (4.155), we can prove that y{t) G Coo C 2 provided the 
condition given in (4.143) is satisfied. Using similar techniques as in the 
proof for Theorem 4.3, all signals can be proved to be bounded during 
closed-loop operation, and hence, y{t) is uniformly continuous. Since it can 
be proven that y{t) G Coo H £2 and y(t) G Coo, Barbalat’s Lemma (see 
Lemma A. 16 of Appendix A) can be invoked to prove the result given in 
(4.144). □ 

4.3.5 Experimental Setup and Results 

Although a considerable amount of theoretical work has been done regard- 
ing the design of advanced position/force controllers, few experimental im- 
plementations of these algorithms have been reported. Furthermore, many 
of these experiments do not forward results on simultaneous position/force 
tracking. Hence, in this section, the performance of the output feedback 
version of the adaptive position/force controller is experimentally demon- 
strated in response to both time- varying position and force trajectories, 
which constitutes the most general position/force control task. The objec- 
tive of the experiment is to force the robot end-effector to move along a 
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vertical wall, parallel to the xi axis at a known distance b while applying a 
force in the direction of the X 2 axis (see Figure 4.5). Hence, the constraint 
function given in (4.62) is calculated to be 



0(xi,X2) = X2 - b — 0. 

The desired position trajectory for the end-effector was selected as follows 

— 11 sin (2. 8t) (l — exp(— 0.3t^)) [cm], 

where the exponential term is included to ensure that Uc^i(O) = Udi(O) = 
Udi(O) = 0 (note from (4.74) that ui(t) = xi(t)), and the desired force 
trajectory was selected as follows 

Ad(0 =0.35fexp(-0.0005^2) [N]. 

The controller was implemented on the 2-link IMI direct-drive manipu- 
lator described in Section 4.2.3 with the exception that a JR-3 force sensor 
was mounted between the end-effector and a wheel tool (see Figure 4.5) to 
measure the end-effector force applied to the wall along the X 2 axis. The 
control gains that resulted in the best performance (in terms of smallest 
steady state error) were determined as follows 

k = 60.0 F = diag {2.0, 1.0, 2.0, 7.0, 20.0} 

Fi = diag (4.0, 1.0, 1.0, 3.0, 3.0, 4.0, 4.0, 

70.0, 3.0, 1.0, 1.0, 1.0, 1.0, 1.0, 1.0} X 10“^. 

The initial values of the parameter estimate vectors of (4.110) and (4.137) 
were set to zero (i.e., no prior knowledge of the nominal parameter values 
is assumed) while the parameter estimate vector of (4.111) was directly set 
to the nominal values (i.e., perfect knowledge of the parameter values was 
assumed) . A standard trapezoidal algorithm was used to compute the inte- 
grals for the parameter estimates while the control algorithm was executed 
at a sampling rate of 1 [msec]. 

The position and force tracking errors (i.e., e(t) and are depicted 

in Figure 4.6. For illustration purposes. Figure 4.7 depicts three of the 
parameter estimate trajectories while Figure 4.8 illustrates a sample in- 
put control torque (i.e., the torque input for link 2). From Figure 4.6, the 
maximum position tracking error is approximately ±1.375 [cm], which is 
approximately 12.5% of the maximum peak value of 11.0 [cm], and the 
maximum force tracking error is approximately ±8.0 [N], which is approx- 
imately 15.5% of the corresponding desired value at t = 20 [sec]. During 




4.4 Visual Servo Control Application 187 



the experimental trials, we noticed that if the force controller was turned 
off, the maximum position tracking error could be tuned to approximately 
ibO.l [cm] (i.e., approximately 0.91% of the maximum peak value). There- 
fore, we believe that while both the direct-drive robot manipulator system 
and the experimental setup (i.e., the constraint wall) were both constructed 
to be very rigid, small flexibilities in the system can cause the position and 
force control loops to affect each other during operation degrading the po- 
sition/force tracking performance. Furthermore, the force measurements 
contain significant low-frequency and high-frequency noise, degrading the 
force tracking performance. 



4.4 Visual Servo Control Application 

As described in the introduction to this chapter, many robotic applications 
are facilitated by the use of a camera-based vision system that can pro- 
vide a sense of perception of the environment. Many current vision-based 
approaches assume that the camera is perfectly calibrated or that the un- 
known parameters can be numerically estimated. Unfortunately, these ap- 
proaches may lead to errors in the calibration parameters that can result 
in unpredictable motion by the robot. In this section, a Lyapunov-based 
visual servoing approach is employed to construct adaptive controllers that 
compensate for the camera uncertainty and to incorporate the effects of 
the robot dynamics. Specifically, for the fixed camera configuration, an 
adaptive controller that achieves global asymptotic tracking despite cam- 
era calibration is developed. In addition, a second adaptive controller that 
compensates for camera calibration parameters and parametric uncertainty 
associated with the robot dynamics is designed. An extension to these con- 
trollers is presented to illustrate how redundant robot manipulators can be 
incorporated into the design. An extension is also presented to illustrate 
how Lyapunov-based methods can be used to construct an adaptive con- 
troller for the camera-in-hand regulation problem. Experimental results are 
used to demonstrate the performance of the controllers for the fixed camera 
configuration. 

4.4.1 System Model 

Camera Model 

The development in this section assumes that a camera is fixed above the 
robot workspace (see Figure 4.9) such that the image plane of the camera 
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is parallel to the robot’s plane of motion (i.e., the degrees of motion of the 
robot manipulator is constrained to be n = 2 for this application), and the 
camera can capture images throughout the entire robot workspace. More- 
over, the fixed camera system is assumed to be modeled by the pinhole-lens 
model [6]. Specifically, by using the pinhole-lens model the task space posi- 
tion of the end-effector of a robot manipulator, denoted by x{t) (see Section 
4.3.1 for the definition of x{t) and for the forward kinematic model of the 
robot manipulator), can be written in terms of image space coordinates, 
denoted by y{t) = [ yi{t) y 2 {t) ] 6 as follows 



y = BR 



X — 



001 

002 



+ 



011 

012 



(4.156) 



In (4.156), [Oil, Oi 2 ]^ G M? denotes the image center that is defined as 
the frame buffer coordinates of the intersection of the optical axis with 
the image plane (see [38] for more details), [Ooi, Oo 2 ]^ ^ denotes the 
projection of the camera’s optical center on the task space plane, B 6 
is a constant positive-definite diagonal scaling matrix defined as follows 




2: 



Pi 

0 



0 

/?2 J ’ 



(4.157) 



and R{9) G SO (2) is a constant rotation matrix defined as follows 



cos {6) — sin (0) 

sin (6) cos (6) 



(4.158) 



where ^ G R represents the constant clockwise rotation angle of the camera 
coordinate system with respect to the task space coordinate system that is 
assumed to satisfy the following inequalities 



-90° <6><90°. (4.159) 

In (4.157), A G R represents the camera’s constant focal length, 2 : G R 
is the positive constant distance from the optical center of the camera to 
the robot’s task space plane along the normal (i.e., the robot motion is 
assumed to be confined to a plane that is parallel to the image plane) , and 
G R represent the camera scale factors (in [pixels/m]) along each 
image space axis, respectively. 

To facilitate the subsequent development and stability analysis, (4.156) 
is written in the following compact form 



y = BRx + p 



(4.160) 
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where p € is a constant vector defined as follows 



P = 



011 

012 



-BR 



001 

002 



(4.161) 



Based on the definitions given in (4.157) and (4.158), respectively, B and 
R{9) are invertible. Hence, the inverse of the image space to task space 
relationship given in (4.160) can be developed as follows 

x{t)^R-^B-\y{t)-p). (4.162) 




FIGURE 4.9. Robot and camera configuration. 



Dynamic Model 

The dynamic model for a two-rigid link revolute direct-drive planar robot 
manipulator is assumed to have the following form [50] 

Mg + + G + F = T (4.163) 

where g(t), q(t)^ q(t) G denote the link position, velocity, and accelera- 
tion vectors, respectively, M(g) G R^^^ represents the link inertia matrix, 
^m{(lA) ^ R^^^ represents centripetal-Coriolis matrix, G{q) G R^ rep- 
resents the gravity effects, F[q) G R^ represents the friction effects, and 
r(t) G R^ represents the torque input vector. Based on the fact that the 
pinhole-lens model relates the image space to the task space, one is moti- 
vated to express the dynamic model given in (4.163) in terms of the task 
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space. To this end, we premultiply (4.163) by the transpose of the inverse 
Jacobian® given in (4.61) and utilize the kinematic relationship given in 
(4.57) to develop the following task space dynamic model [50] 

M* X + G* + F* = T* (4.164) 

where x{t) is defined in (4.56), M*(x) G V^{x,x) G R^^^, G*(x) G 

R^, F*(a;,x) G R^, and r*(t) G R^ are defined as follows 

M* = J-^M J-^ J-i (4.165) 

G* - J-^G F* = J-^F, r* = J-^r, 

and J{q) was defined in (4.58) (where n = 2 for this application). 

Property 4.9: Symmetric £ind Positive-Definite Inertia Matrix 

The inertia matrix is symmetric positive-definite and satisfies the follow- 
ing inequalities 

mi lief < (x) e < m 2 lien" ve e R" (4.166) 

where mi, m 2 G R are known positive constants, and H-H denotes the 
standard Euclidean norm. 

Property 4.10: Skew-Symmetry 

The inertia and centripetal-Coriolis matrices satisfy the following skew- 
symmetric relationship 

e"’ (^\ m *{ x ) - i)) e = 0 ve e r” (4.167) 

where M{q) denotes the time derivative of the inertia matrix. 

Property 4.11: Linearity in the Parameters 

The left-hand side of (4.164) can be linearly parameterized as shown 
below 

M* i + G* -f F* = (4.168) 

where (j) G R"^ contains the constant system parameters, and the regression 
matrix Y{x^x^x) G R^^"^ is assumed to be bounded provided that x{t)^ 
x{t), x{t) G Coo- 



®As in the previous sections, we assume that kinematic singularities of the robot 
manipulator are always avoided (i.e., J~^{q) always exists). 
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4.4.2 Control Objective 

The control objective in this section is to enable a robot end-effector to 
track a desired time- varying image space trajectory despite the fact that the 
camera is uncalibrated (i.e., the constant parameters in (4.157) and (4.158) 
are assumed to be unknown). To quantify the tracking control objective, an 
image space end-effector position tracking error e{t) = [ ei(t) e 2 {t) ] G 
is defined as follows 

e{t) = yd{t) -y{t) (4.169) 

where yd{t) C R^ denotes the desired image space trajectory^ and y{t) 
is defined in (4.160). By utilizing (4.156), the image space end-effector 
position tracking error can also be defined in terms of the mismatch between 
the actual and desired task space end-effector trajectory as follows 

e{t) - BR {xd{t) - x{t)) (4.170) 

where the desired task space trajectory, denoted by Xd{t) G R^, can be 
formulated from the desired image space trajectory by using the inverse 
camera model given in (4.162) as follows 

Xd = R-^B-\yd-p) (4.171) 

where Xdif) is assumed to be always located in the robot workspace and 
that y{t) is always in the image plane of the camera. Based on the expres- 
sions given in (4.169) and (4.170), if the image space position of the robot 
manipulator is proven to track the desired image space trajectory (i.e., if 
limt_oo e(t) = 0), then the task space position of the manipulator can be 
proven to track the desired task space trajectory (i.e., limt_oo = ^d(^))- 
That is, convergence of the end-effector position tracking error in the im- 
age space will result in convergence of the end-effector position tracking 
error in the task space. Since the desired trajectory is being generated via 
an uncalibrated camera (i.e., the parameters of the matrices B and R{0) 
are unknown), the expression in (4.171) indicates that the desired task 
space trajectory is unknown. Hence, the measurable image space track- 
ing error expression given in (4.169) will be utilized in the subsequent 
control development. That is, the camera system will be used for the 
dual purpose of generating the desired trajectory and as a feedback sig- 
nal in the subsequent closed-loop controller. As in previous sections, to 
facilitate the control development, a filtered tracking error, denoted by 



^We make the standard assumption that the desired image-space trajectory of the 
robot end-eflFector is constructed such that 2/d(t), yd(i), € ^oo- 
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r{t) = [ ri{t) r 2 {t) ] G is defined as follows 

r{t) = e{t) + ae{t) (4.172) 

where a G R^^^ is a diagonal positive-definite control gain matrix. 



4.4.3 Adaptive Control Development 

In this section, two adaptive control laws are developed that ensure global 
asymptotic tracking control. Specifically, the first adaptive control design 
compensates for parametric uncertainty associated with the camera cali- 
bration (i.e., the constant parameters in (4.157) and (4.158)), while the 
parameters of the dynamic model are assumed to be exactly known. The 
second controller compensates for parametric uncertainty throughout the 
entire camera and robot system. Each of these controllers “close-the-loop” 
in the image space; hence, the actual control inputs to the robot actua- 
tors must be computed according to (4.165). Based on the fact that x{t), 
x(t)j x(t) cannot be directly measured due to the parametric uncertainty 
in the camera calibration parameters, the link positions are directly mea- 
sured from encoders at each joint. Specifically, the subsequent control laws 
require y(t), y{t), q{t), and q{t) to be measurable. 



Adaptive Control Example 1 



In this example, a solution to the so-called adaptive camera calibration 
problem [6] is developed. That is, our aim is to design a controller that 
provides link position tracking and compensates for all of the unknown 
camera calibration parameters. In this first example, the parameters associ- 
ated with the robot dynamics (i.e., inertia, mass, and friction) are assumed 
to be exactly known. In the subsequent example, the control design will 
target end-effector position tracking despite parametric uncertainty in the 
camera model and the robot dynamic model. 

Under the assumption that exact model knowledge of the robot dynamics 
is available, a feedback linearizing approach can be employed to directly 
cancel the nonlinear dynamic effects (i.e., dynamic inversion [49]). To this 
end, we take the second time derivative of (4.162) as follows 



where the constant matrix A G 



A = 



Ai 

As 



A2 

A4 



Ay = X 

^2x2 is defined as follows 

z cos {9) z sin {9) 






XPi 

z sin (0) 



A^2 

zcos{9) 



(4.173) 



(4.174) 
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where B and R{0) are defined in (4.157) and (4.158), respectively. After 
substituting (4.164) into (4.173) for x(t) the following expression is obtained 

Ay 3= (r* - V^x - G* - F*) . (4.175) 

Based on the form of (4.175), the following feedback linearizing control 
input can be designed 



r* = M*u + + G* + F* (4.176) 

where u(t) = [ ui(t), U 2 {T) ] C is a subsequently designed con- 
trol term. After substituting (4.176) into (4.175) for r*(t), the following 
simplified open-loop dynamic system is obtained 



Ay{t) = u. (4.177) 

To develop the open-loop error system for r{t) of (4.172), we take the 
time derivative of (4.172), premultiply the resulting expression by A, and 
then substitute (4.177) for Ay{t) to obtain the following expression 

Ar = A{yd + ae) — u. (4.178) 



Motivated by the subsequent stability analysis to ensure that the matrix 
that premultiplies r{t) in (4.178) is positive-definite, a constant upper- 
triangular transformation matrix, denoted by T C is defined as fol- 

lows 



T = 



1 As A 2 

det (A) A 4 A 4 det (A) 

0 1 



(4.179) 



After premultiplying (4.178) by T, the following expression is obtained 



Zr = Z{yd + ae) — Tu 



(4.180) 



where the constant symmetric matrix Z G is defined as 



Z = TA = 



1 + 4 

A4 

As 



^3 

A 4 



(4.181) 



Based on the structure of (4.181), the expressions in (4.159) and (4.174) 
can be used to prove that Z is positive-definite. 

To facilitate the adaptive camera calibration design, (4.180) is linear 
parameterized as follows 



4>3^ {Ycl4>l - Ui) 

[ Vc 2</>2 - U 2 



(4.182) 
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wh.eieYci{e^U 2 ,t) ^ and Yc 2 {e,t) G are known regression ma- 

trices defined as 



Vci -[ ydi+ aiei yd2 + a2h «2 ] 
yc2 = [ ydi+ aiei yd2 + 0^262 ] 



(4.183) 



and (/>! G R^, </>2 G R^, and (^3 G R represent unknown constant parameter 
vectors that are defined as follows 






(l + 4)det(A) A3det(A )-^2 

A 4 A 4 



iT 



(4.184) 



02 — [ ^3 A 4 



03 = det (A) . 



Based on the open-loop dynamics of (4.182) and the subsequent stability 
analysis, u{t) is designed as follows 



Ui = Yci^i -f kciVi U2 = Yc2^2 + ^c2^2 (4.185) 

where /cd, kc 2 G R are positive control gains. In (4.185), 0i(t) G R^ and 
02(0 ^ denote dynamic parameter estimates that are defined by the 
following gradient update laws 



^1= ^2= rc2Vc2^2 (4.186) 



where Fd G R^^^ and Fc2 G R^^^ are diagonal positive-definite gain ma- 
trices. After substituting (4.185) into (4.182), the following closed-loop dy- 
namics for r{t) can be obtained 



(t>3 - <t>3 

Yc 2^2 - ^c2r2 



(4.187) 



where the parameter estimation error vectors 0i(O ^ ^J^d 02(0 ^ 
are defined as follows 



0, = 0,-0, Vz = l,2. (4.188) 

The stability of the adaptive camera calibration controller can now be 
examined by using the following theorem. 

Theorem 4.5 The adaptive camera calibration controller given in (4-176), 
(4-185), and (4-186) ensure global asymptotic end- effector position tracking 
in the sense that 

lim e(0 = 0 

t^oo ^ ’ 

provided the condition given in (4-159) is satisfied. 



(4.189) 
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Proof: To prove Theorem 4.5, we define a nonnegative function V{t) c M 
as follows 

V = (4.190) 

After differentiating (4.190), and then substituting (4.187) and the time 
derivative of (4.188) into the resulting expression, the following expression 
can be obtained 

V = -<p^^kcirj - kc 2 rl < - min {</)“ 3 ^fcci, fcc 2 } lk||^ (4.191) 

where (4.186) was utilized. Due to the structure of (4.190) and (4.191), 
^ 2(0 ^ ^00 r{t) G C 2 can be proved. Based on the fact that 
^(^5 ^ 2(0 ^ ^00 5 ffic closed-loop error systems (i.e., standard signal 

chasing arguments) can be used to show that all system and controller 
signals are bounded. Having proved that r(t) G Coo ^ C 2 and r{t) G £00 > 
Barbalat’s Lemma (see Lemma A. 16 of Appendix A) can be used along with 
Lemma A. 15 of Appendix A to prove the result given in (4.189). □ 



Adaptive Control Example 2 

The adaptive calibration controller in the previous example required exact 
knowledge of the mechanical parameters to provide asymptotic position 
tracking. In this example, an adaptive backstepping control law is designed 
to take into account parametric uncertainty throughout the entire system. 
To this end, we take the time derivative of (4.169) and premultiply the 
resulting expression by A as follows 

Ae = Aijd — V -\- T] (4.192) 

where (4.174) and the time derivative of (4.162) were utilized, and the 
auxiliary tracking error signal r]{t) G M? is defined as follows 

rj = V — X (4.193) 

T 

where v{t) = [ vi{t) V2{t) ] G is a subsequently designed control 
signal. After premultiplying (4.192) by the transformation matrix T defined 
in (4.179), the following expression is obtained 

Ze = Z yd — Tv Tt] (4.194) 



where the matrix Z was defined in (4.181). In a similar manner as in the 
previous section, the open-loop dynamics of (4.194) can be rewritten in the 
following advantageous form 
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where <f) 2 , and ^3 were defined in (4.184), and Yi{v 2 ,t) G and 

Y 2 (t) G are known regression matrices defined as follows 

^1 = [ Vdi Vd2 -V2 ] V '2 = [ Vdi Vd2 ] ■ (4.196) 

Based on the form of (4.195) and the subsequent stability analysis, the 
control input v(t) is designed as follows 



^1 = ^101 + V2 = Y2^2 + ^ 2^2 ( 4 . 197 ) 

where ki^ k 2 G R are positive constant control gains, and (^i(^), 02(0 
(4.186) are redesigned in this example as follows 



^2^T2Y^e2 (4.198) 



where Fi G R^^^ and F 2 G R^^^ are diagonal positive-definite gain matri- 
ces. After substituting (4.197) into (4.195) for f(t), the closed-loop dynam- 
ics for e(t) are obtained as follows 



Ze = 



(ri^i-fciei) 

I2 02 ~ ^2^2 



-h Tt]. 



(4.199) 



To develop the open-loop dynamics for r/(t), we take the time derivative 
of (4.193), premultiply the resulting equation by M*{x), and then make 
use of (4.164) and (4.193) to obtain the following expression 

M*f] = -^77 + ^ - r* - r^e (4.200) 

where ^(x,x,u,t;,e) gR^ is defined as follows 

^ = M*v -f- v;;^v -f G* + F* -h T^e (4.201) 

and T^e was added and subtracted to (4.200) to cancel the interconnection 
term Tr]{t) of (4.199) during the subsequent stability analysis. By exploit- 
ing Property 4.11 and the structure of T given in (4.179), the following 
expression can be developed 



^ - Yn(t>n + A (4.202) 

where A(e) G R^ and the linear parametrization Yn{x,x^v^v^e)(l)^ G R^ are 
defined as follows 

A = [ 0 62 f 



(4.203) 
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M* 



+ nriFi^ei + fciei 

^202 + ^ 2 r 2 ^ 2 ^ ^2 + ^ 2^2 



+ V;: 



Yi0i + A^iei 

^202 + ^2^2 



+G* + F* 4 - 



1 

det {Af'^ 
^3 ^2 

A 4 A 4 det (A) 



ei 



(4.204) 

In (4.204), Yn{x,x,v,v,e) G denotes a known regression matrix, (f)^ G 
R^ denotes a vector containing unknown constant parameters associated 
with the camera and robot, and the time derivative of Yi{v 2 ^t) and Y 2 {t) 
of (4.196) are given by the following expressions 



Yi = [ Vdi yd2 -h ] Y2= [ jjdi Vd2 ] ■ (4.205) 



After substituting (4.202) into (4.200) for ^(x, x, i;, e), the following open- 
loop error system can be obtained for r]{t) 



M*T] = -V:^r] + Yn(l>^ + k- T^e - t* . (4.206) 

Based on the structure of (4.206) and the subsequent stability analysis, 
the control input r*(t) is designed as follows 

T* =A^Yj^ + KnV (4.207) 

where Kn C R^^^ is a diagonal positive-definite control gain matrix and 
0^(t) G R^ is a dynamic parameter estimate that is defined by the following 
gradient update law 

0„=r„yj7? (4.208) 

where Fn 6 R^^^ is a diagonal positive-definite gain matrix. After substi- 
tuting (4.207) into (4.206) for r*(t), the following closed-loop dynamics for 
r]{t) are obtained 



M*rj = -V:,r] + Yn~^n-KnV-T^e (4.209) 

where the parameter estimation error ^^(^) G R^ is defined as follows 

(4.210) 

The stability of the adaptive controller in (4.197), (4.198), (4.207), and 
(4.208) can now be examined by using the following theorem. 
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Theorem 4.6 The adaptive control law given in (4-197), (4-198), (4-207), 
and (4-208) ensures global asymptotic end- effector position tracking in the 
sense that 

lim eft) = 0, (4.211) 

t—^oo 

provided the condition given in (4-159) is satisfied. 



Proof: To prove Theorem 4.6, we define a nonnegative function F (/:) G R 
as follows 

(4.212) 



After taking the time derivative of (4.212), substituting (4.199) and (4.209) 
into the resulting expression for Ze{t) and M*{x)i]{t), respectively, substi- 



tuting the adaptive update laws given in (4.198) and (4.208) for (t). 



02 and ft), and then utilizing the skew-symmetry property in 
(4.167), the following expression can be obtained 



V - -cj)^^kiel-k2el-r]'^KnT} 

< -min {03 ^/ci,A; 2 } ||e||^ - Amin {Kn} \\v\\^ ■ 



(4.213) 



The result given in (4.211) and boundedness of all the signals under closed- 
loop operation can be shown by utilizing (4.212), (4.213), and similar ar- 
guments as in the proof of Theorem 4.5. □ 



4.4.4 Redundant Robot Extension 

Redundant manipulators provide increased fiexibility and dexterity for the 
execution of complex tasks. The extra degrees of freedom of the redundant 
manipulator not only increase the workspace area, but also enable the exe- 
cution of sub-control tasks. In this section, the adaptive controller of Section 
4.4.3 is modified for redundant revolute planar manipulators (i.e., the re- 
striction that n = 2 is removed). Given that the robot motion is limited to 
two degrees of freedom and the manipulator has n-joints, the manipulator 
Jacobian defined in (4.58) will not be square (i.e., J{q) G R^^^). Since the 
nonsquare manipulator Jacobian is not invertible, a pseudo-inverse of J{q), 
denoted by J'^{q) € can be defined as follows 

j+ = 



(4.214) 
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where J^{q) satisfies the following equality 

JJ+ = h. 



(4.215) 



As shown in [64], the pseudo-inverse defined by (4.214) satisfies the Moore- 
Penrose Conditions given below 



JJ+J = J J+JJ+=J+ 

{j+jf = J+J {JJ+f = JJ+ 



(4.216) 



and the matrix In — J, which projects vectors onto the null space of 
J(g), satisfies the following properties 



(In ~ J^J) (In - J-^ J) ^In- J 
{In - J^J)^ = {In - J^J) 



J(/„- J+J) =0 

{In - J) = 0 



(4.217) 



where the minimum singular value of J(q) is assumed to be greater than a 
known small positive constant ^ > 0, such that sup {||«/'^(g)||} is known a 

priori, and hence, all kinematic singularities are always avoided. 

Following a similar control design strategy as delineated in Section 4.4.3, 
the closed-loop dynamics for e(t) given in (4.199) can be developed as 
follows 






03-' {Wi 01 - fciei) 

W 2 02 - ^ 2^2 



+ T{V - Jq) 



(4.218) 



where (4.57) and (4.193) have been utilized. After using (4.215) and (4.217), 
the following expression can be obtained 



Ze = 



03 ' (Wi 01 - fciei) 

W 2 02 - ^2^2 



+ TJg 



where q(t) G is defined as follows 



g = J+v -f (In - J~^J) g-q 



(4.219) 



(4.220) 



where In £ denotes the nxn identity matrix and g(t) G denotes a 

bounded design vector that is used to control the self-motion of the redun- 
dant manipulator to accomplish sub-tasks. The open-loop error dynamics 
for g(t) can be obtained by taking the time derivative of (4.220) and pre- 
multiplying the resultant equation by the inertia matrix M(q) of (4.163) 
as follows 



M-g = -Vmg + Vr0r ~ - T 



(4.221) 
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where the linear parameterization Yr{q^q,v^v,e)(j)^ £ M? is defined as fol- 
lows 

Yr4>r = {J+v + (7„ - J+J) g} + J^T^e ^^ 222) 

+Vm{J+v + {In-J+J)g} + G + F 

where yrC*) ^ is a known regression matrix, and (j)^ G is a vector 

containing unknown, constant parameters associated with the camera sys- 
tem and mechanical dynamics. Based on the structure of (4.221), the joint 
space control input r(t) can be designed in a similar fashion as in Section 
4.4.3. By following steps similar to that used in the proof of Theorem 4.6, 
global asymptotic position tracking and global asymptotic tracking of the 
auxiliary variable g{t) (i.e., \imt-,oo 9{t) — 0) can be proven. More- 
over, given that limt_,oo ^(0 ~ expression in (4.216) can be used to 

show that q{t) converges to g{t) in the null space of J{q) as shown below 

lim ^ = 0 => lim (In - J-^J) (g-q)= 0. (4.223) 

t— >oo t—^oo 

Thus, the vector g(t) can be used to control the self-motion of the re- 
dundant manipulator to perform subtasks [30] (e.g., obstacle avoidance, 
joint-limit avoidance, to maximize manipulability of the robot, to mini- 
mize energy consumption). 

Remfirk 4.6 A stability proof for the redundant robot extension cannot be 
formulated to prove that q(t) G Coo- However, the remaining signals and 
the control law can be proven to be bounded (i.e., all of the occurrences of 
q(t) are within sinusoidal terms for revolute robots). For revolute redundant 
robots, the lack of a proof for the boundedness of q(t) is typically not a 
concern since the self-motion effects can cause the actuators to continually 
turn. 



4.4.5 Camera- in-Hand Extension 

The control laws developed in Section 4.4.3 are based on a fixed camera 
configuration. However, for some applications, the camera may be mounted 
directly on the end-effector of the robot (i.e., the camera-in-hand configura- 
tion) as illustrated in Figure 4.10. To address these applications, the control 
objective in this section is to regulate the task space position of a robot 
end-effector (and hence, the camera) so that the task space projection of 
the camera’s optical center is equal to a constant desired setpoint. Given 
that the camera is now assumed to be mounted on the robot end-effector, 
the relationship between the task space position of the end-effector and the 
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image space coordinates of an object given in (4.156) is modified as follows 
[41] 

y = BR(x-Xd) (4.224) 

where Xd G denotes the constant desired task space setpoint. For the 
fixed camera configuration, the rotation matrix R{’) was defined as a func- 
tion of the unknown constant orientation of the camera. For the camera- 
in-hand configuration, the camera orientation, denoted by 02 (^) ^ K? will 
change as a function of the robot link positions as follows 

2 

0^ = 0 + (4.225) 

i-1 

where 6 is the unknown constant orientation of the camera given in (4.158), 
and qi(t) G M denotes the link position. To facilitate the subsequent 
control design, the camera-in-hand rotation matrix can be divided into a 
unknown constant rotation matrix multiplied by a measurable time- varying 
rotation matrix as follows 

R{62) = + • ( 4 - 226 ) 



In the subsequent development, the rotation matrices given in (4.226) are 
distinguished by the following notation 



R = R{6) 




(4.227) 



Remark 4.7 As with the fixed camera configuration, the following assump- 
tions are made: (i) Xd is always located in the robot workspace, (ii) the 
camera’s image plane is parallel to the object plane, (Hi) the camera can 
capture images throughout the entire robot workspace, and (iv) kinematic 
singularities are always avoided (i.e., J~^{q) G always exists). 

Control Design 

To quantify the control objective for the camera-in-hand problem, the task 
space position error, denoted by ex{t) G R^, is defined as follows 

ex = Xd- X. (4.228) 

After taking the time derivative of (4.228) and utilizing the forward kine- 
matic relationship given in (4.57), the following expression can be obtained 



= JVx - 



(4.229) 
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Image-Space 




FIGURE 4.10. Camera-in-hand configuration, 
where 6 is defined as follows 

(4.230) 

and u{t) G represents the kinematic control input. Based on the struc- 
ture of (4.229) and the subsequent stability analysis, u(t) is designed as 
follows 

u = -J~^kcRl{q)y (4.231) 

where /Cc G R is a positive control gain. After utilizing (4.224), (4.227), and 
(4.231), the following closed- loop error dynamics can be obtained 

= -kcRl{q)BRRk{q)e^ + Jr]^. (4.232) 

To develop the open-loop dynamics for we take the time derivative 

of (4.230), premultiply the resulting equation by M{q), and then use (4.163) 
and (4.193) to obtain the following expression 

Mr], = - T (4.233) 

where Yxiv^y^qA) ^ R^^^ denotes a known regression matrix, (f), G R^ 
denotes the constant unknown system parameters, and the linear parame- 
trization Yx{y,y,q^q)(f), is defined as follows 

Yx(f>x — Mil -f- -\- G -\- F. (4.234) 

Based on the form of (4.233) and the subsequent stability analysis, the 
control torque input can be defined as follows 

r = Yx^x + ^sVx -h 



(4.235) 
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where kg G R is a positive control gain, and £ R^ is a dynamic 

parameter estimate for that is defined by the following gradient update 
law 

(4.236) 

where G R^^^ is a diagonal positive-definite gain matrix. After substi- 
tuting (4.235) into (4.233) for r(t), the following closed-loop error dynamics 
can be obtained 

^Vx = -VmVx - f^sVx + '^x^x - J^^x (4.237) 

where the parameter estimation error vector (t) G R^ is defined as follows 

(4.238) 

Stability Analysis 

The stability of the adaptive camera-in-hand controller given in (4.231), 
(4.235), and (4.236) can now be examined by the following theorem. 

Theorem 4.7 Provided that the camera-space parameters satisfy the fol- 
lowing inequality 

where 6 is given in (4.225) and j3i, /?2 defined in (4.157), the adaptive 
camera-in-hand controller given in (4-231), (4-235), and (4-236) guarantees 
global asymptotic regulation in the sense that 

lim ex{t) — 0. (4.240) 

t-^oo 

Proof: To prove Theorem 4.7, we define a nonnegative function V (t) G R 
as follows 

V = (4.241) 

After taking the time derivative of (4.241), substituting (4.232) and (4.237) 
into the resulting expression for ex{t) and M(q)fj^{t), respectively, utilizing 
the skew-symmetry property of (4.167), and then cancelling common terms, 
the following expression can be obtained 

V = -kcelRl{q) Rf,(q)ex, - ifksT]^ (4.242) 
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Note that if (4.239) is satisfied, the symmetric matrix BR + (BR)^ will 
be positive-definite (see Lemma B.18 of Appendix B), and hence, Lemma 
A. 12 of Appendix A can be invoked to prove that 

< -fccA^in I ( I lie, ||2 _ fc, 11^^ ||2 (4.244) 



where Amin {*} denotes the minimum eigenvalue of a matrix. Given (4.241) 
and (4.244), 6x(t), ^x{t) G £oo and ex{t), G £2 can be proved. 

Standard signal chasing arguments can be used to show that all system 
and controller signals are bounded. Having proved that (t) G Coo H C 2 
and ex{t) G £00 Barbalat’s Lemma (see Lemma A. 16 of Appendix A) can 
be invoked to prove the result given in (4.240). □ 



Remark 4.8 With respect to (4-239)^ note that 



0 < 






01 + 02 



< 1 , 



and that the condition on 9 can be written as 9 e { — |^d > |^c|} where 9c is 
determined from a given set of values for j3i and /? 2 - If the camera^s scale 
factors have the same value (i.e., f3i = ^ 2 )^ then 9c — 90° as in the fixed 
camera configuration examples. As the difference between the values of j3i 



and P 2 i'^creases, the ratio 



~02 






1, and hence, 9c 



0°. Since in 

« 1 , 



^ l ~^2 

/5i +/32 



most camera systems and P 2 have similar values (i.e., 
and hence, 9c » 0°^, the condition given in (4-239) is not difficult to 
satisfy in practice. 



4.4.6 Experimental Setup and Results 

To illustrate the performance of the controllers proposed in Section 4.4.3, an 
experimental testbed (see Figure 4.11) was constructed that consisted of the 
following components: (i) the 2-link IMI revolute direct-drive manipulator 
described in Section 4.2.3, (ii) a Dalsa (CA-D6-0256W) MotionVision area 
scan digital camera that captures 955 frames per second with 8-bit gray 
scale at a 256x256 resolution, (iii) a Road Runner Model 24 video capture 
board, and (iv) two Pentium Il-based PCs operating under the real-time 
operating system QNX. The camera was mounted 1.2 [m] above the robot 
workspace, and an LED was placed at the tip of the robot’s second link to 
provide an easily detectable feature to indicate the end-effector position. 
One of the PCs (600 [MHz]) was connected to the camera system and was 
used to capture the image, extract the desired feature, and transmit the 
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FIGURE 4.11. Schematic representation of the robot /camera experimental test- 
bed. 



pixel coordinates to the shared memory of a second PC over a 100 [Mb/sec] 
dedicated Ethernet connection. A simple thresholding algorithm was used 
to detect the position of the LED in the camera frame. 

The other PC (450 [MHz], operating under QNX) was connected to the 
robot manipulator and used to acquire the pixel coordinates provided by 
the first PC from a shared memory location and perform the real-time I/O 
and control computations. Link encoders were used to determine the link 
positions and an approximate link velocity was determined from the link 
position via a backward difference/filtering operation. The link position 
and velocity signals were utilized to calculate the task space position and 
velocity of the end-effector. The task space position and velocity signals are 
required for calculation of the feedforward terms in the control law associ- 
ated with the robot dynamics (i.e., the inertia related terms, the friction 
terms, and the gravity terms). Data acquisition and control implementa- 
tion were performed at 1 [kHz] via the Quanser MultiQ I/O board with 
custom interfacing circuitry. The control algorithms were executed using 
the real-time control environment Qmotor [16]. 

Since the output of the camera system is discrete, a low-pass filtering 
procedure was applied to the camera output signal to obtain a contin- 
uous differentiable signal for the control input. Specifically, we used a 
second-order Butterworth filter with a 300 [Hz] cut-off frequency. By using 



^^The application of the filter on the pixel information means that “approximate” 
sub-pixel information is being used to close the control loop. 
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a bilinear transformation the following discretized filter was obtained 



2/W = 



Zb ~ 



(4.245) 



where 

Zh = x{t — 2ts) + 2uP‘ x{t — ts) + x{t) 

Za = {2w^ - &/ts) y{t - ts) + - ^w/ts + 4w/f^) y{t - 2ts) 

(4.246) 

where x{t)^y(t) G M denote the filter input and output, respectively, w = 
1884.956 [Hz] denotes the experimentally determined filter cut-off frequency 
(i.e., it was selected to remove the sharp edges of the camera input signal), 
and ts — 0.001 [sec] denotes the sampling time. A standard backward 
difference/filtering process was utilized to enable calculation of the camera- 
space velocity via numerical differentiation of the position signal. 

From the dynamic model of (4.53), the unknown parameter vector given 
in (4.204) was constructed as follows 

A3 A2 \ Y 
A 4 A 4 det(A) / 

(4.247) 

where the static friction effects are considered as unmodeled disturbances. 
To ensure that the manipulator was configured to eliminate mechanical 
singularities and to provide for the maximum camera view, the following 
desired trajectory signal was generated in the camera space for both ex- 
periments 



<f>n = 



Pi P 2 P3 Fdl Fd2 



det(A) 



130 + ax cos (3.5t) — ay sin(3.5t) 
150 -f ay cos (3.5t) — sin(3.5t) 



(4.248) 



where ax = 72 and ay — 150 represent the distance between the initial 
position of the end-effector in the image plane and the center of the image 
plane. Figure 4.12 illustrates the desired task space and the resultant de- 
sired image space trajectory. To highlight the effects of the adaptation, the 
initial values of all the parameter estimates were set to zero. 



^^For a visual servoing control design that does not require camera space velocity 
measurements, see [66]. 
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Experiment 1: The control and adaptation gains for the adaptive visual 
servo controller given in Section 4.4.3 were selected as follows 

a = [ 2.182 1.875 Kr = [ 0.77 0.96 

Tci = [ 0.0001 0.0001 0.0001 I'c2=[ 0.0001 0.0001 ]^. 

(4.249) 

The actual image space trajectory of the robot end-effector is illustrated 
in Figure 4.13. Figures 4.14, 4.15, and 4.16 illustrate the image space link 
position tracking error, the camera calibration parameter estimates, and 
the torque control inputs, respectively. As shown in Figure 4.14, the steady 
state image space link position tracking errors were between ±2 [pixels] for 
both links. 

Experiment 2: The control and adaptation gains for the adaptive visual 
servo controller given in Section 4.4.3 were selected as follows 

fci = 1.412 ^2 = 1.40 Kn-=[ 1.39 1.40 ]’’ 

Ti = [ 0.009 0.009 0.009 ]’’ T2 = [ 0.009 0.012 ]’’ 
r„=[ 0.0004 0.0001 0.0002 0.0002 0.0002 0.0002 0.0004 j’^. 

(4.250) 

The actual image space trajectory of the robot end-effector is illustrated in 
Figure 4.17, and the link position tracking error is illustrated in Figure 4.18. 
Figures 4.19 and 4.20 depict the parameter estimates for the camera para- 
meters and the robot parameters, respectively, and Figure 4.21 illustrates 
the control torques. 



Remark 4.9 As can be observed from the tracking error plots (Figures 
4’ 14 and 4’ 18 ), the adaptive camera calibration controller reaches its steady 
state in approximately 3 [sec] with an overshoot of 6%, while the adaptive 
robot controller reaches its steady state in approximately 10 [sec] with an 
overshoot of 23%. The main reason for this behavior is the adaptive robot 
controller has more parameter estimates. Hence, a higher overshoot (ap- 
proximately 16 [pixels]) occurs during the transient period, and the system 
takes longer to reach the steady state. Note that the overshoot can be re- 
duced if the parameter estimates are initialized to values closer to the actual 
parameter values. 




Link 2 Tracking Error (pixels] Link 1 Tracking Error [pixels] 
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FIGURE 4.14. Link position tracking errors for the adaptive visual servo con- 
troller. 
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FIGURE 4.15. Parameter estimates for the adaptive visual servo controller. 
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FIGURE 4.18. Link position tracking errors for the adaptive visual servo con- 
troller. 
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FIGURE 4.19. Camera parameter estimates for the adaptive robot controller. 
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FIGURE 4.20. Mechanical system parameter estimates for the adaptive robot 
controller. 





FIGURE 4.21. Control input torques for the adaptive robot controller. 
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4.5 Background and Further Reading 

Based on characteristics such as a relatively simple structure and the abil- 
ity to compensate for a broad class of periodic disturbances that are man- 
ifested in many robotic applications, learning-based control schemes have 
been the target of considerable effort. Some of the initial learning control 
research set as a goal the development of betterment learning controllers 
(see [2, 3, 4]). Unfortunately, one of the drawbacks of the betterment learn- 
ing controllers is that the robot is required to return to the same initial 
configuration after each learning trial. In [28], Heinzinger et al. provided 
several examples that illustrated the lack of robustness of the betterment 
learning controllers to variations in the initial conditions of the robot. To 
address these robustness issues, Arimoto [1] incorporated a forgetting fac- 
tor in the betterment learning algorithm given in [3, 4]. Motivated by the 
results from the betterment learning research, several researchers investi- 
gated the use of repetitive learning controllers. One of the advantages of 
the repetitive learning scheme is that the requirement that the robot re- 
turn to the exact same initial condition after each learning trial is replaced 
by the less restrictive requirement that the desired trajectory of the ro- 
bot be periodic. Some of the initial repetitive learning control research was 
performed in [27, 54, 55]. However, the asymptotic convergence of these 
basic repetitive control schemes could only be guaranteed under restrictive 
conditions on the plant dynamics that might not be satisfied. To enhance 
the robustness of these repetitive control schemes, researchers in [27, 54] 
modified the repetitive update rule to include the so-called Q-filter. Unfor- 
tunately, the use of the Q-filter did not lead to faster convergence of the 
tracking error to zero. In the search for new learning control algorithms, 
researchers in [29, 43] proposed an entirely new scheme that exploited the 
use of kernal and influence functions in the repetitive update rule. How- 
ever, this class of controllers tends to be fairly complicated in comparison 
to the control schemes that utilize a standard repetitive update rule. In 
[20], the authors illustrate how the standard repetitive update rule could 
be partially saturated (ensuring the boundedness of the repetitive update 
rule) to yield global asymptotic tracking. 

In [53, 57], iterative learning controllers (ILCs) were developed that do 
not require differentiation of the update rule, so that the algorithm can 
be applied to sampled data without introducing differentiation noise. In 
[9, 10, 11, 58], ILCs were developed to address the motion and force con- 
trol problem for constrained robot manipulators. In [12], Cheah and Wang 
developed a model-reference learning control scheme for a class of nonlinear 
systems in which the performance of the learning system is specified by a 
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reference model. In [61], Xu and Qu use a Lyapunov-based approach to 
illustrate how an ILC can be combined with a variable structure controller 
to handle a broad class of nonlinear systems. In [24], Ham, Qu, and John- 
son utilized Lyapunov-based techniques to develop an ILC that is combined 
with a robust control design to achieve global uniformly ultimately bounded 
link position tracking for robot manipulators. The applicability of this de- 
sign was extended to a broader class of nonlinear systems by Ham, Qu, and 
Kaloust in [25]. Recently, several researchers (see [13, 26, 34, 35]) have used 
a class of multiple-step “functional” iterative learning controllers to damp 
out steady state oscillations. As stated in [35], the fundamental difference 
between the previous learning controllers and the controllers proposed in 
[13, 26, 34, 35] are that the ILC is not updated continuously with time; 
rather, it is switched at iterations triggered by steady state oscillations. 
Han, Kim, and Ha used this iterative update procedure in [26] to damp out 
steady state oscillations in the velocity set-point problem for servo motors. 
The work in [26] was extended by [13] to compensate for friction effects and 
applied in [34] to video cassette recorder (VCR) servo motors (see [44, 45] 
for a comprehensive review and tutorial on ILC). 

Motivated by the numerous industrial/manufacturing apphcations that 
require a robot manipulator to make contact with the environment, signifi- 
cant research efforts have targeted simultaneous control of the end-effector 
position and the interaction force. For example, a nonlinear reduced order 
transformation was introduced in [42] that allowed the constrained robot 
dynamics to be represented by a reduced-order model and hence, facilitated 
the separate design of position and force control strategies. In [21], Grabbe 
et al. compared and contrasted the transformation proposed in [42] with 
other position/force techniques. Most of the previous work on the simul- 
taneous position/force tracking control problem requires feedback of link 
position, link velocity, and end-effector force. For example, results devel- 
oped in [5, 63, 67] involved the design of other adaptive full-state feedback 
position/force tracking controllers that yielded asymptotic position/force 
tracking (see [8, 31, 37, 51, 52]). Motivated by the work in [7, 65], in which 
high-pass filters were designed to generate velocity-related signals for ro- 
bust and adaptive position tracking controllers for unconstrained robot 
manipulators, the authors of [17] developed an adaptive output feedback 
controller that achieved semi-global position/force tracking. Colbaugh and 
Glass [14] also designed an adaptive position/force controller without veloc- 
ity measurements that achieved semi-globally uniformly bounded position 
tracking/force regulation. Experimental results for position/force regula- 
tion or position tracking/force regulation are presented in [14, 56, 59, 60]. 
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Inspired by the desire to provide robots with an improved sense of per- 
ception that would enable autonomous operation in unstructured environ- 
ments, researchers have investigated vision-based sensing for over forty 
years. As stated in [15], most of this research has been aimed at image 
extraction and feature recognition, and the results of this research have 
been successfully commercialized. Within the last decade, researchers have 
investigated leveraging off of the previous image extraction and feature 
recognition technology to embed visual information in the feedback loop of 
the robot controller (i.e., visual servoing). From a review of literature (an 
overview of various robot visual servoing research is provided in [22, 46]), 
there seems to be a consensus that to extract high-level performance from 
vision-based robotic systems, the control system must incorporate infor- 
mation about the dynamics/kinematics of the robot and the calibration 
parameters of the camera system. With regard to the vision system. Bishop 
and Spong [6] emphasized the importance of adequate camera calibration 
with respect to the robot and the environment. As noted in [6], while a va- 
riety of techniques have been proposed for off-line camera calibration, only 
a few approaches were aimed at the more interesting problem of on-line 
calibration under closed-loop control. 

Recently, some attention has been given to the design of vision-based 
control schemes (accompanied by stability analyses) that guarantee the 
convergence of the position error while accounting for uncalibrated camera 
effects and the mechanical dynamics of the robot. For example, Kelly and 
Marquez [33] designed a setpoint controller that compensated for unknown 
intrinsic camera parameters but required perfect knowledge of the camera 
orientation. Later, Kelly [32] redesigned the setpoint controller of [33] to 
also take into account uncertainties associated with the camera orientation, 
resulting in a local asymptotic stability result. In [6], Bishop and Spong 
developed an inverse dynamics, position tracking control scheme (i.e., exact 
model knowledge of the mechanical dynamics are required as in the first 
adaptive visual servo control example presented in this chapter) with an 
on-line adaptive camera calibration control loop that guaranteed global 
asymptotic position tracking. However, convergence of the position tracking 
error required that the desired position trajectory be persistently exciting. 
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5 

Aerospace Systems 



5.1 Introduction 

In many aerospace applications, large amplitude maneuvers are performed 
that require a high degree of accuracy. Aerospace applications also typi- 
cally require a system to track a time- varying reference trajectory rather 
than a simple setpoint regulation. These objectives motivate the need to 
incorporate the nonlinear dynamic effects of the system in the control sys- 
tem synthesis. However, the problem is further complicated because the 
mass and inertia are not exactly known due to fuel consumption, payload 
variation, appendage deployment, etc. Many existing control strategies for 
aerospace systems use singular (i.e., the Jacobian matrix in the kinematic 
equation is singular for some orientations) three-parameter attitude repre- 
sentations such as Euler angles, which are only locally valid. As described 
in Chapter 2, the unit quaternion is a four-parameter representation that 
can be used to globally represent the attitude of an object without singular- 
ities. However, an additional constraint equation is introduced. Along this 
line of reasoning, a full-state feedback quaternion-based attitude tracking 
controller is first developed for the nonlinear dynamics of a rigid space- 
craft^ with parametric uncertainty in the inertia matrix. Motivated by the 
desire to eliminate additional sensor payload, a second controller is devel- 



^The words spacecraft and satellite are used interchangeably in this chapter. 
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oped under the additional constraint that angular velocity measurements 
are not available. The developed output feedback control strategy is proven 
to be globally valid with the exception of a mild restriction on the initial 
conditions of the system that can be easily satisfied. 

Spacecrafts typically utilize separate devices to provide energy storage 
and attitude control. Conventionally, the energy collected from solar ar- 
rays is stored in chemical batteries, and the stored energy is then used 
when the spacecraft is in the earth’s shadow. The typical configuration for 
spacecraft attitude control includes an array of reaction wheels or control 
moment gyros. An alternative configuration may include the use of fiy- 
wheels. Flywheels store kinetic energy within a rapidly spinning wheel-like 
rotor or disk. Modern fiywheels employ a high-strength composite rotor, 
which rotates in a vacuum chamber. A motor powered off the solar arrays 
can be mounted on the rotor’s shaft to spin the rotor up to speed (also 
referred to as charging). The rotor’s kinetic energy provides the torque 
required for the desired spacecraft maneuvers and sustains vital process- 
ing and communication procedures on board. A high-strength containment 
structure houses the rotating elements and low-energy-loss bearings can be 
used to stabilize the shaft (e.g., the magnetic bearings described in Chapter 
2 could be used in tandem with the active autobalancing scheme described 
in Chapter 3). Flywheels have several advantages over traditional battery 
systems including (i) fiywheels contain no acids, (ii) flywheels are not af- 
fected by temperature extremes, as most batteries are, and (iii) flywheels 
facilitate integrated power and attitude tracking applications. This last ad- 
vantage allows the integration of the energy storage and attitude control 
functions via the use of four or more noncoplanar flywheels, and thereby, 
reduces the spacecraft bus mass, volume, cost, and maintenance require- 
ments while maintaining or improving the spacecraft performance. This 
system is commonly referred to as an integrated power and attitude con- 
trol system (IPACS) [3]. The integration of these two functions is achieved 
by decomposing the space of internal torques of the flywheel array into 
two orthogonal subspaces, the range space and null space of the torques, 
with decoupled control objectives (i.e., attitude tracking and energy/power 
tracking, respectively) [14, 17, 38]. As a result, the energy management 
function can be accomplished without affecting the attitude control func- 
tion. Following this design concept, an adaptive IPACS is developed for a 
nonlinear spacecraft model where the body torque is produced by flywheels 
that are operated in a reaction wheel mode. The adaptive quaternion-based 
controller forces a spacecraft to track a desired attitude trajectory while 
simultaneously providing exponential energy/power tracking. 
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Another key technological concept in aerospace systems is the idea of dis- 
tributed functionality of a large spacecraft among smaller, less expensive, 
cooperative spacecraft [4, 30]. Flying two or more spacecraft in a precise for- 
mation is typically referred to as multiple satellite formation flying (MSFF) 
and presents a number of complex challenges. The spacecraft must have a 
sensory and control system that enables it to attain and maintain a precise 
position relative to the other spacecraft. The spacecraft must also have a 
communication, sensory, and control system that allows it to attain a spec- 
ifled attitude, with all spacecraft targeting the desired object /trajectory. 
The United States Air Force and National Aeronautics and Space Adminis- 
tration (NASA) have identified MSFF as an enabling technology for future 
missions and have shown a keen interest in the development of a reliable 
autonomous formation keeping strategy to deploy multiple spacecraft for 
space missions (e.g., the Earth Orbiter-I (EO-I) and the New Millennium 
Interferometer, also known as Deep Space-3). Specifically, the EO-1 forma- 
tion flying effort demonstrates the capability of satellites to react to each 
other and maintain a close proximity without human intervention. This 
advancement allows satellites to react autonomously to each other’s orbit 
changes quickly and more efficiently. It permits scientists to obtain unique 
measurements by combining data from several satellites rather than flying 
all the instruments on one costly satellite. It also enables the collection of 
different types of scientific data unavailable from a single satellite, such as 
stereo views or simultaneously collecting data of the same ground scene 
at different angles. Following this paradigm, the relative position control 
problem for MSFF is considered. Specifically, the full nonlinear dynamics 
describing the relative positioning of MSFF is used to develop a Lyapunov- 
based nonlinear adaptive control law that guarantees global asymptotic 
convergence of the position tracking error in the presence of unknown con- 
stant, or slow- varying spacecraft masses, disturbance forces, and gravity 
forces. 



5.2 Attitude Tracking 

This section presents a full-state feedback adaptive control solution to the 
quaternion-based attitude tracking control problem that compensates for 
parametric uncertainty in the spacecraft inertia matrix. Based on the struc- 
ture of the full-state feedback control design and the stability analysis, a 
second controller is then developed under the additional constraint that an- 
gular velocity measurements are not available. Specifically, a novel trans- 
formation is first applied to the open-loop quaternion tracking error dy- 
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namics. The transformed tracking error dynamics are then used to design 
a new adaptive full-state feedback controller that compensates for uncer- 
tainties in the inertia matrix. A Lyapunov-like function, which exploits the 
quaternion constraint equation, is used to prove asymptotic attitude track- 
ing. To eliminate the requirement for velocity measurements, a nonlinear 
filtering scheme is employed to generate a velocity-related signal from atti- 
tude measurements. The output feedback controller is also proven to yield 
asymptotic attitude tracking. 

5.2.1 System Model 

The attitude motion of a rigid body is represented by a kinematic equation 
that relates the time derivatives of the orientation angles to an angular 
velocity vector and by Euler’s dynamic equation that describes the time 
evolution of the angular velocity vector. As described in Chapter 2, sev- 
eral singular three-parameter representations (e.g., the Euler angles, Gibbs 
vector, Cayley-Rodrigues parameters, and modified Rodrigues parameters) 
exist to represent the attitude of a rigid body. However, the subsequent 
model development will be based on the four-parameter unit quaternion 
representation since it provides a nonsingular representation. 




FIGURE 5.1. Relationship between coordinate frames. 
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Kinematic Model 

Let T represent a body-fixed orthogonal coordinate frame attached to the 
center of mass of a rigid spacecraft. Let B denote a body-fixed coordinate 
frame that is offset from ^ by a translation as depicted in Figure 5.1. The 
spacecraft is equipped with actuators that provide body-fixed torques to 
each axis of S by a pair of equal and opposite forces that act in a direction 
perpendicular to the line joining the actuators [1]. Let X denote an inertial 
reference frame (e.g., attached to the earth center). As stated in Chap- 
ter 2, the position and orientation of these coordinate axes are commonly 
represented by homogeneous transformation matrices, from which several 
different representations can be utilized to develop the kinematic model. 
Recall from Chapter 2 that three-parameter representations are singular. 
Hence, in this section the unit quaternion vector q{t) =[go(t), (t)]^ G 

with qo{t) G R and qv(t) G R^, is used to relate the attitude of B and T to 
X {B and T have the same orientation). As also stated in Chapter 2, the 
unit quaternion is subject to the following constraint 

qlqv+ql = i- ( 5 . 1 ) 

Given the unit quaternion parameterization, the rotation matrix that brings 
X onto .F, denoted by R{q) G 50(3), is defined as follows 

{Qo- qlqv) h + (5.2) 

where is the 3x3 identity matrix, and the notation denotes the 
following skew-symmetric matrix 

r 0 -Cs C 2 1 

= C 3 0 -Cl VC = [ Cl C 2 Cs ] • ( 5 . 3 ) 

L -C2 Cl 0 . 

To facilitate the subsequent control development and stability analysis, 
we also exploit the fact that q{t) is related to the angular velocity of T 
with respect to X expressed in T ^ denoted by cj(t) G R^, via the following 
differential equation [3, 27] 



qv = ^(qv^^ + qo^) 

1 y 

qo = 



( 5 . 4 ) 

( 5 . 5 ) 



Based on (5.4) and (5.5), the angular velocity can also be written as follows 



tu = 2 (goqv ~ qvqo) ~ “^q^qv 



( 5 . 6 ) 
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The desired attitude of the spacecraft is assumed to be described by a 
desired body-fixed reference frame Td whose orientation with respect to the 
inertial frame X is specified by the desired unit quaternion —[Qod{t)^ 
that is constructed to satisfy the following constraint 

<lvdQvd + qod = '^- (5-7) 

The objective in this section is to design a control input to ensure that 
the attitude of T tracks the attitude of Td where the rotation matrix that 
brings J onto Td is denoted by Rd{qd) ^ S'0(3), where Rd{qd) can be 
calculated from qd{t) as follows 

Rd (qd) = {qld - qldqvd) h + “^qvdqld ~ ^qodq^d- ( 5 - 8 ) 

As in (5.4) and (5.5), the desired angular velocity of Td with respect to X 
expressed in Td, denoted by ujd{t) G can be obtained from the following 
dynamic equations 

qvd = 2 (lvd‘^d + qodi^d) (5.9) 

qod = -^qld^d- (5.10) 

That is, (5.9) and (5.10) can be used to compute Ud {t) as shown below 

^d — 2 {qodqvd qvdqod) ^qyd^yd 

where the standard assumption is made that qod{i), qvd{^), and their first 
three time derivatives are bounded for all time. This assumption ensures 
that uJd{t) of (5.11) and its first two time derivatives are bounded for all 
time. 

To quantify the mismatch between the actual and desired spacecraft 
attitudes, the rotation matrix R{e) € 50 (3) that brings Td onto T can be 
defined as follows 

R = RRd = {el - e^e„) I 3 + 2e„e^ - 2eoe^ (5.12) 

where R{q) and Rd(qd) were defined in (5.2) and (5.8), respectively, and 
the quaternion tracking error e(t) =[eo{t), c^(t)]G R"^ is defined as follows 

eo = qoqod + qlqvd (5.13) 

ey = qodqv - qoqvd + q^qvd- (5.14) 

Based on (5.9), (5.10), (5.13), and (5.14), the following open-loop quater- 
nion tracking error kinematics can be developed 

^ (e(( + eo/ 3 ) w 

1 X ~ 

eo = 



(5.15) 

(5.16) 
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where oj{t) G denotes the angular velocity of T with respect to Td 
expressed in T ^ and is defined as follows 

u) = u — Rwd‘ 

Remark 5.1 The relations given in (5.13) and (5.14) can be explicitly 
calculated via quaternion algebra by noticing that the quaternion equivalent 
of (5.12) is the quaternion product (see [44] Theorem 5.3 of [23]) 

e = QdQ (^-18) 

where qd(t) = [Qod(t), —Qvd{i)] ^ 'Is the unit quaternion representing the 
rotation matrix • 

Dynamic Model 

The dynamic model for the rigid spacecraft can be expressed as follows 
[18, 19] 

Juj = —uj^ J(jo u (5.19) 

where J G R^^^ represents the constant positive-definite symmetric iner- 
tia matrix, u{t) is introduced in (5.4-5. 6), and u{t) G R^ is a vector of 
control torques. In (5.19), the spacecraft inertia matrix is uncertain due to 
phenomena such as fuel consumption, payload variation, and appendage 
deployment. Based on (5.4), (5.5), (5.9), (5.10), (5.13), (5.14), and (5.17), 
the dynamic model given in (5.19) can be rewritten as follows 

J oj= - + ^d^ J (w-{- Rwd^ + J (u^^d - ^d^ + u (5.20) 

where the following fact has been used^ [36] 

R=-Cu^R. (5.21) 

To facilitate the subsequent stability analysis, (5.15) can be rewritten as 
follows 

e„ = ^Toj (5.22) 

where the Jacobian- type matrix T (e) G R^^^ is defined as follows 

r = < + eo/3. (5.23) 



^The negative sign in equation (5.21) is because the coordinates of (5.17) are ex- 
pressed in terms of the body-fixed coordinate frame rather than the inertial reference 
frame. 
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After taking the time derivative of (5.22) and premultiplying both sides of 
the resulting expression by J*(e), the following expression can be obtained 

J*e^ = 1 J*Tw + (i) (5.24) 

where J*(e) G is defined as follows 

J* = T~^JT-^. (5.25) 

By substituting (5.20) and (5.22) into (5.24), the following expression can 
be obtained 

J*e^ + + AT* = (5.26) 

where (5.3) has been used. In (5.26), the transformed control input u^{t) G 
R^ is defined as follows 

U* = (5.27) 

where the transformed dynamic terms, denoted by C* (e^Cy) G R^^^ and 
N* {e,ey^ujd^(^d) ^ R^, are defined as 

C* = -rfT-^ - 2T~^ {JT-^Cy) "" T~^ (5.28) 

AT* = T-T' ({T-^e^Y JR^d)+T-'^ "" JT-^e,) 

+ ((A^d) J^d) - \t~^J ((2r-ie„) ^ Bwd - • 

(5.29) 

The transformed dynamic model given in (5.26) satisfies the following prop- 
erties that will be utilized in the subsequent control development and analy- 
sis. 

Property 5.1: Skew- Symmetry 

The transformed inertia and centripetal-Coriolis matrices satisfy the fol- 
lowing skew-symmetric relationship (see Lemma B.19 of Appendix B) 

^^(ij’-C'*)^ = 0 V^eR^ (5.30) 

Property 5.2: Bounded Inertia Matrix 

The inertia matrix can be lower and upper bounded as follows 



h < h lief ve G R" 

where ji, ^ R denote positive bounding constants. 



(5.31) 
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Rem 2 irk 5.2 To examine the conditions that ensure that T{e) of (5.23) 
can be inverted, the determinant T(e) can he computed as follows 

det(r) =eo{t). (5.32) 

From (5.32), it can be determined that T{e) is invertible provided eo(t) ^ 0 
for any time. To ensure that eo(t) ^ 0 for all time, the desired trajectory 
must be initialized to guarantee that eo(0) ^ 0^ and the subsequent control 
design must ensure that eo(t) ^ 0 after the initial time. 

5.2.2 Control Objective 

The attitude tracking control objective is to force the actual attitude of 
a spacecraft to track a desired time- varying attitude trajectory. Based on 
(5.12), the attitude tracking control objective can be mathematically for- 
mulated as follows 

lim R{e{t)) = h. (5.33) 

t—^oo 

Based on (5.1), (5.7), (5.13), and (5.14), it is clear that the unit quaternion 
tracking error satisfies the following constraint 

e^e„+e^ = l (5.34) 

where 

0 < ||e^(t)|l <1 0 < |eo(t)| < 1. (5.35) 

Given (5.34) and (5.35), the orientation tracking objective given in (5.33) 
can also be formulated in the terms of the unit quaternion error introduced 
in (5.13) and (5.14). Specifically, it is obvious from (5.34) that 

if lim ey(t) = 0, then lim |eo(t)| = 1. (5.36) 

Hence, (5.12) and (5.36) can be utilized to prove that 

if lim ey(t) = 0, then lim R{e) = /s (5.37) 

t— >00 t— +00 

(i.e., the attitude tracking objective given in (5.33) is achieved). 



5.2.3 Adaptive Full-State Feedback Control 

In this section, the control objective is to design an adaptive attitude con- 
troller for the open-loop tracking error dynamics given by (5.26) under the 
constraint that the spacecraft inertia matrix is unknown and under the 
assumption that q(t) and q(t) (and hence, ey{t) and Cyft)) are measurable. 
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A filtered tracking error, denoted by r{t) G is defined to facilitate the 
controller design as follows 



r = 6y aey (5.38) 

where e^(^) and ey{t) are defined in (5.14) and (5.15), respectively, and 
a G is a constant positive-definite diagonal control gain matrix. 

Closed-Loop Error System 

To develop the closed-loop tracking error system, we take the time deriva- 
tive of (5.38) and then premultiply both sides of the resulting equation by 
J* to obtain the following expression 

rr = rey-\- raey. (5.39) 

After substituting (5.26) into (5.39), the following expression can be ob- 
tained 

J*f = -C*r + y<9 + u* (5.40) 

where (5.38) has been used and the linear parameterization Y (•) ^ is defined 
as follows 

Y9 = raey + C*aey - N\ (5.41) 

In (5.41), Y (e, e-i,,cjd,a;d) G R^^^ denotes a known regression matrix and 
0 G R^ denotes a constant unknown vector of inertia parameters defined as 
follows 

0 =[Jn Ji2 Jn J22 J23 J 33 (5.42) 

where Jij \fi^j = 1, 2, 3 denote inertia matrix elements. Based on the open- 
loop tracking error system given by (5.40) and the subsequent stability 
analysis, the control input u*{t) is designed as follows 

u* = -re -Kr 2 (5-43) 

(1 - e'^Cy) 

where AT G R^^^ is a constant positive-definite diagonal control gain ma- 
trix, and 6{t) G R^ denotes a parameter estimate vector for (5.42) that is 
generated by the following gradient update law 



e=TY'^(-)r (5.44) 

where F G R^^^ is a constant positive-definite diagonal adaptation gain 
matrix. After substituting (5.43) into (5.40) for u*(t), the following closed- 
loop tracking error dynamics can be obtained 

Cy 

(1 - e'^eyf 



J*r = -C*r + Y6-Kr- 



(5.45) 
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where 6{t) G denotes the following parameter estimate error signal 



e{t) = e-e{t). 



(5.46) 



Stability Analysis 

The adaptive full-state feedback controller of (5.43) and (5.44) provides 
asymptotic attitude tracking as stated by the following theorem. 

Theorem 5.1 The adaptive attitude controller given in (5.43) and ( 5 . 44 ) 
ensures asymptotic attitude tracking in the sense that 

lim Cy it) — 0 and lim uit) = 0 (5.47) 

provided that the initial conditions are selected such that 

eo (0) ^ 0. (5.48) 



Proof: To prove Theorem 5.1, we define a nonnegative function F(t) G R 
as follows 




T 

ej 6y 
1 - ej’ct, 






(5.49) 



where y{t) G R^ is defined as follows 



y = T 



(5.50) 



where T(e) and r(t) are defined in (5.23) and (5.38), respectively. After tak- 
ing the time derivative of (5.49), utilizing (5.25), (5.44), (5.45), and (5.50), 
and cancelling common terms, the following expression can be obtained 



V{t) = 



e" Cy 



(1 - e^eyf 



r^C*r — r^ Kr — 



T 

e„ 



(1 - 



+ j*r. 



(5.51) 



After substituting (5.38) into (5.51) for e^,(t), the following expression can 
be obtained 



V{t) = 



—e'Oaey 



r^Kr 



(5.52) 



where the skew-symmetric property given in (5.30) has been used. 

The development given in (5.49) and (5.52) can be used to prove that 



0<l^(0<^(0)<oo, (5.53) 

and hence, y{t), 6{t) G Coo- Based on (5.53), the development given in 
(5.34), (5.35), (5.48), and (5.53) can be used to prove that 



ey{t)\\ < 1. 



(5.54) 
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The constraint introduced in (5.34) and the initial condition constraint 
given in (5.48) can be used in conjunction with the inequality given in 
(5.54) to prove that eo (t) is nonzero for all time. Hence, (5.32) can be used 
to prove that T(e) is invertible for all time. Since y{t) € £oo ^(^) is 
invertible for all time, (5.50) can be utilized to prove that r(t), 6{t) G £oo- 
Given that r(t) G £ooj Lemma A. 13 of Appendix A can be invoked to prove 
that ey{t), ey{t) G £oo- Hence, (5.25), (5.28), (5.29), (5.41), (5.45), and 
(5.54) can be used to prove that y(-), r{t) G Coo- The differential equation 

given in (5.44) can be used to prove that 6 (t) G Coo, a-nd the expressions 
given in (5.27) and (5.43) can be used to prove that u{t), G Coo- 

Based on (5.52) and (5.53), Lemma A. 11 of Appendix A can be invoked 
to prove that r(t) G £ 2 - Based on the fact that r{t)^r{t) G Coo ^nd that 
r{t) G C2, Barbalat’s Lemma (see Lemma A. 16 of Appendix A) can be 
invoked to prove that 

lim r (t) = 0. (5.55) 

t—*oo 

Based on (5.38) and the result obtained in (5.55), Lemma A. 15 of Appendix 
A can be invoked to prove that 

lim 6y {t ) , 6y (t) — 0. (5.56) 

t— »oo 

Based on (5.22) and the fact that T(e) is invertible, (5.56) can be used to 
prove that 

lim uj{t) =0. □ (5.57) 

t—^00 

5.2.4 Adaptive Output Feedback Controller 

The adaptive control development in the previous section is based on the 
assumption that full-state feedback is available. However, the cost of hav- 
ing accurate angular velocity sensors for each axis on a spacecraft may be 
prohibitive. The requirement for additional sensors (that are not in a redun- 
dant configuration) decreases the system reliability. Moreover, most angular 
velocity sensors yield noisy measurements that require costly processing 
before they can be usefully utilized in the control algorithm. The back- 
wards difference algorithm is commonly employed to produce a surrogate 
for velocity measurements without requiring additional sensors. However, 
this approach is theoretically unsatisfying because the effects of the back- 
wards difference algorithm are not examined in the stability analysis. Mo- 
tivated by the desire to design a control torque input that eliminates the 
need for velocity measurements, a filtered tracking error signal, denoted by 
eyf{t) G is defined as follows 

Gyf kCy -h P 



(5.58) 
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where /c G R is a positive, constant control gain, and p{t) G is generated 
by the following differential expression and initial condition 

p = - (/c -h 1) p + H ^ 2 P (0) = (0) • (5.59) 

(1 

To facilitate the subsequent stability analysis, an error signal, denoted by 
T]{t) G M^, is defined as follows 

TJ Sy G^y f “t“ Gy (5.60) 

where 7]{t) is unmeasurable because it is dependent on velocity measure- 
ments. 



Closed-Loop Error System 

To determine the closed-loop dynamics for eyf{t), we take the time deriv- 
ative of (5.58) and then substitute (5.59) into the resulting expression as 
follows 

Syf = -key - (k-\-l)p-\- k^Cy H — 2 • (5.61) 

(1 - e'^Sy) 

After utilizing (5.58) and (5.60), the closed-loop dynamics for eyf{t) can 
be rewritten as follows 

evf = -kr] - eyf -h - — (5.62) 

(1 Cy) 

To develop the closed-loop expression for ? 7 (t), we take the time derivative 
of (5.60), premultiply the resulting expression by J* (•) of (5.25), and then 
substitute (5.26) for J* (•) Cy (t) to obtain the following expression 

rrj = u* - C^Gy - + rey -h (5.63) 

To facilitate further development, the following linear parameterization is 
defined 

WdO = -Jiod - (5.64) 

where Wd{i^d)<^d) ^ is a known regression matrix, and 9 is the vector 
of unknown constant inertia parameters introduced in (5.42). After adding 
and subtracting WdO to the right side of (5.63) and utilizing (5.60) and 
(5.62), (5.63) can be rewritten as follows 

ri] = u* - krp - + X + WdO (5.65) 

where x(e, Gyf.p^t) G is defined as follows 



X = C* {Gyj + e,) + J* U - e, + - 2reyf - WdO - N\ 

\ {l-eTey) J 

(5.66) 
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The auxiliary signal x(e, G defined as follows facilitates the 
subsequent stability analysis 



X - T^X (5.67) 

where x(-) is introduced in (5.66). Based on the boundedness assumptions 
for the desired attitude trajectory and the structure of (5.67), x (*) can be 
upper bounded as follows (see Lemma B.20 of Appendix B) 

llxll<p(lkll)ll^ll (5.68) 



where p(-) G M is a positive, nondecreasing function, z(t) G MP is defined 
as 






v/r 



et, 



T T 

y 



(5.69) 



and y{t) G is redefined for the output feedback case as follows 

y^T-^r). (5.70) 



Based on the structure of (5.26) and the subsequent stability analysis, 
the transformed control input is designed as follows 

u* = -Wd6 + ke,f - (5.71) 

(1 -c; ey) 

where Wd{‘) was introduced in (5.64), k is the same control gain intro- 
duced in (5.58), and 6{t) G is a parameter update law generated by the 
following differential expression 






(5.72) 



where F G is a positive-definite diagonal constant control gain matrix. 
To illustrate that 9{t) can be calculated using only measurable signals, 

(5.72) can be rewritten as the following integral expression 

0(f)=r / Wj {u)d{(T),uJdicr)){ey{(T)+ey{a) + eyf{a))da + 0{0). 

Jo 

(5.73) 

After performing integration by parts, (5.73) can be written in the following 
velocity-independent output feedback form 



e 




wj (•) (ev (cr) + Byf (a)) - ivj (.) By {a) 



da + TWje^+e{0). 

(5.74) 
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Based on the subsequent stability analysis, the control gain given in (5.58) 
and (5.71) is selected as follows 

A; = 1 (fc„ + 1) (5.75) 

3i 

where ji was defined in (5.31), and G R denotes a positive, constant 
control gain. After substituting (5.71) into (5.65) for u*(t), the following 
closed-loop error system can be obtained 

rf^^X + WdO +-{K + 1) (e„/ - J*77) - 2 - C*n (5.76) 

^1 (1-e^e^;) 

where 6{t) was defined in (5.46) and (5.75) was used. 



Stability Analysis 

The adaptive output feedback control strategy of (5.58), (5.71) and (5.74) 
yields asymptotic attitude tracking as stated by the following theorem. 

Theorem 5.2 Given the closed-loop error systems of (5.60), (5.62), and 
(5.76), the adaptive controller of (5.58-5.71) and (5.7 f) ensures asymptotic 
attitude tracking in the sense that 



lim Cy (t) = 0 and lim uj(t) = 0 (^•T’T) 

t—^oo t—*oo 



provided that the desired trajectory is selected to ensure that eo(0) ^ 0, 
and the control gain kn introduced in (5.75) is selected according to the 
following inequality 





(5.78) 



where p(-) was defined in (5.68), x{t) G R^^ is defined as follows 



X = 



6 






(5.79) 



and Xi, A 2 are positive constants defined as 

Ai = i min Amin {r“^}} A2 = ^ max {l, j2, A^ax {r~^}} , 

(5.80) 

where Amin {•} Amax {•} represent the minimum and maximum eigen- 
value of a matrix, respectively. 



Proof: To prove Theorem 5.2, we define a nonnegative function V{t) G R 
as follows 



2 V-e^e, 



+ + -jv Jy 






(5.81) 
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Based on the structure of (5.81) and the boundedness property given in 
(5.31) for the inertia matrix, V{t) can be lower and upper bounded as 
follows 

Ai ||a;||^ < < A2 l|a;||^ (5.82) 

where x(t) was defined in (5.79), and Ai, A 2 were defined in (5.80). After 
taking the time derivative of (5.81), substituting (5.70) for y{t), using (5.25) 
and (5.76), and then cancelling common terms, the following expression can 
be obtained 






T • 



(1 - 



+ ^vf^vf 






X + WdO + — {kn + 1) {cyf — J*ri) 



Ji 



(1 - e'^e^y 



-c*v\- 



(5.83) 

After utilizing (5.60), (5.62), (5.67), (5.70), and the skew-symmetric prop- 
erty of (5.30), (5.83) can be rewritten as follows 



V== -- 



V T . T— 

2 +y^ X 



(1 - e^ey 



-j- {kn + 1) rj'^rr, + 0^ ( wJt] + r-i e 



(5.84) 



After utilizing (5.25), (5.72), and (5.70), the following inequality can be 
developed 



V < 



(1 - eleyf 



-elfeyf-{kn + l)\\yf + \\y\\\\x\\- 



(5.85) 



After substituting (5.68) into (5.85) for x (-)5 following expression can 
be obtained 



^<-pir+ \\y\\\\4p{\\4)-kn\\yr 



(5.86) 



where (5.69) was utilized. By completing the squares on the bracketed term 
in (5.86) (see also the nonlinear damping tool in Lemma A. 17 of Appendix 
A) the following expression can be obtained 



V < 



1 - 




(5.87) 



By using the definition given in (5.79), the inequality given in (5.87) can 
be written as follows 
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where /? 6 M is some positive constant. Given (5.82), the following sufficient 
condition can be developed 

m 

Ai 

From (5.82) and (5.89), the following inequalities can be obtained 

0<F(^)<F(0)<oo, (5.90) 

and hence, y{t), ^(^)? ^ >Coo- The inequalities given in (5.82) and 

(5.90) can now be used to formulate the following sufficient condition for 
(5.89) 

V <-(i\\zf for 

Based on (5.90), the development given in (5.34), (5.35), (5.48), and 
(5.53) can be used to prove that 



!k(o)il 



(5.91) 




V<-!3\\z\\ 



for 






\\ev{t)\\ < 1. (5.92) 

Given (5.34) and the assumption that the desired trajectory is selected 
to ensure that co(0) ^ 0, the inequality given in (5.92) can be used to 
prove that eq (t) is nonzero for all time. Hence, (5.32) can be used to prove 
that T(e) is invertible for all time. Since y{t) G Coo and T(e) is invertible, 
(5.70) can be used to prove that r]{t) G Coo. If is now possible to utilize 
the previous development and (5.60) to prove that e^(t) G Too- Based on 
(5.92) and the facts that ey{t), 9(t), eyf{t) G Too, (5.69) and (5.79) can 
be used to prove that z{t), x{t) G Too- Since e^f (t), (t) G Too 

and ||e^;(t)|| < 1, (5.62) can be used to prove that eyf(t) G Too- Given 
z{t) G Too, (5.68) can be used to determine that x(') ^ Too- Based on 
the fact that ^ ^vf (t) , Cy (t) G Too, (5.76) and the result given 

in (5.92) can be used to prove that rj (t) G Too- Based on (5.92) and the 
facts fj{t), 6y (t), 6yf (t) G Too, the definition given in (5.69) can be used 
to determine that z{t) G Too- Based on (5.88) and (5.90), Lemma A.ll of 
Appendix A can be invoked to prove that z (t) G T 2 . Based on the fact 
that z(t),z(t) G Too and that z{t) G T 2 , Barbalat’s Lemma (see Lemma 
A. 16 of Appendix A) can be invoked to prove that 

lim^(t)=0 for kn > ( \ ^ \\x {0)\\\ . (5.93) 

t—^00 \ V / 

Since T{e) is invertible, (5.22), (5.60), (5.69), (5.70), and (5.93) can be used 
to obtain the result given in (5.77). □ 
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5.2.5 Simulation Results 

Numerical simulation results were obtained to validate the adaptive output 
feedback controller developed in (5.58-5.71) and (5.74). The simulation is 
based on the following inertia matrix [1] 





■ 20 


1.2 


0.9 " 


J = 


1.2 


17 


1.4 




0.9 


1.4 


15 



[kg-m^]. 



(5.94) 



The initial spacecraft attitude was selected as 

go(0) = qv{0) = [ 0 -V05 -y/0A5 f (5.95) 

and the parameter estimates were initialized to zero (typically, the para- 
meter estimates would be initialized to the best-guess values, however, the 
simulation is based on the assumption that no knowledge of the parameter 
values is available). The desired attitude trajectory was selected as follows 

qod = V^ qvd{t) = [ \/0^sin(t) \/0.45 cos{t) \/0.45 cos{t) ]^. 

(5.96) 

The control gain introduced in (5.58) and the adaptation gain matrix in- 
troduced in (5.72) were selected as follows 

k = b0 Tii = 5000 Vz = 1,2, ...6. (5.97) 

The attitude and angular velocity tracking errors are depicted in Figures 
5.2 and 5.3. The dynamic estimates of the inertia matrix are shown in 
Figure 5.4. The resulting control torque input is shown in Figure 5.5. 



5.3 Energy /Power and Attitude Tracking 

In the previous section, adaptive controllers were developed to achieve at- 
titude tracking. However, the energy/power required to achieve the desired 
attitude maneuvers was not considered. Motivated by the economics associ- 
ated with spaceflight and the desire to achieve extended mission life cycles, 
the need for a power management system that operates in tandem with the 
controller (i.e., an IPACS) is strong. In this section, an adaptive IPACS is 
developed that forces a spacecraft to track a desired attitude trajectory 
while simultaneously providing exponential energy/power tracking. 
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5.3.1 System Model 

In this section, the same spacecraft system described in the previous section 
is used (see Figure 5.1). However, in this section, the body-fixed torques 
are assumed to be applied by an array of n (where n > 3) noncoplanar 
fiywheels with a fixed axis of rotation with respect to B (i.e., reaction wheel- 
type mode of operation). A four noncoplanar fiy wheel cluster operating in 
reaction wheel mode is depicted in Figure 5.6 where Wi, W 2 , W 3 , W 4 denote 
fiywheel clusters. The same differential equations introduced in (5.4) and 
(5.5) govern the attitude kinematics. As stated in [18, 38], the nonlinear 
dynamic model for the fiywheel driven system can be written as follows 

Ju = — (jj^AJfCjf — At/ (5.98) 

JfUf=Tf. (5.99) 

In (5.98) and (5.99), cu{t) G denotes the spacecraft angular velocity 
with respect to the inertial reference frame X expressed in terms of the 
body-fixed coordinate frame B, o^f{t) € MX is the axial angular velocity of 
the flywheels^ with respect to S, J G represents the unknown con- 

stant positive-definite symmetric inertia matrix inclusive of the fiywheels, 
J/ G is the unknown constant positive-definite diagonal matrix of the 

axial moments of inertia of the fiywheels, A G R^^^ is a constant torque 
transmission matrix whose columns contain the axial unit vectors of the n 
fiywheels, and Tf(t) G R^ is the fiywheel torque control input. Based on 
(5.99), the kinetic energy of the flywheel array can be determined as follows 

E{t) = ^wJ{t)JfUjf{t). (5.100) 



5.3.2 Control Objective 

The control objective in this section is to design the flywheel torque con- 
trol input such that the flywheels track a desired energy /power profile, and 
the spacecraft tracks a desired attitude trajectory. The desired kinetic en- 
ergy profile is denoted by Ed (t) G R and the desired power requirement 
is denoted by Pd(t) € R. The energy /power profiles are assumed to be se- 
lected so that Ed (t), Pd{t) ^ >Coo, and the profiles are related through the 



^In formulating (5.98) and (5.99), the flywheels are assumed to spin at a much higher 
speed than the spacecraft [38]. 
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FIGURE 5.6. Schematic for flywheels in reaction wheel mode, 
following integral expression 

Ed{t)= [ Pd{a)da. (5.101) 

Jo 

To quantify the energy tracking objective, a kinetic energy tracking error 
G R is defined as 

T]E = Ed-E. (5.102) 

Based on (5.101) and (5.102), the power tracking error can be quantified 
by the following expression 



f]E = Pd- E. (5.103) 

As stated in the previous section, the open-loop quaternion attitude track- 
ing error system is given by (5.15) and (5.16), where it is assumed that 
the desired attitude trajectory is selected such that LOd{i), ^d{t) G Coo- 
To facilitate the subsequent IPACS development and stability analysis, an 
auxiliary attitude tracking error signal, denoted by rj{t) G R^, is defined as 
follows 

T] = Co^Kiey (5.104) 

where K\ G R^^^ is a constant positive-definite diagonal control gain ma- 
trix. The subsequent control development will target the control objectives 
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under the constraint that the spacecraft inertia matrix J is unknown and 
under the assumption that the spacecraft attitude q (t), spacecraft angular 
velocity q{t)^ and flywheel axial angular velocities Uf (t) are measurable. 



5.3.3 Adaptive IPACS 

To develop the closed-loop dynamics for the attitude tracking error, we 
take the time derivative of (5.104), premultiply by the inertia matrix, and 
then utilize (5.17) to obtain the following expression 



Jfj = Ju — J RuJd — JR^d + JKiCy. (5.105) 

After substituting (5.15) and (5.98) into (5.105) for Cy (t) and cb (^), respec- 
tively, and then using the following fact"^ [36] 



R= -Cj^R, 

the open-loop dynamics for rj (t) can be obtained as follows 



(5.106) 



Jf] = Y6 — AJfUjf — At/. (5.107) 



In (5.107), the linear parameterization Y{‘)9 is deflned as follows 

Y0 = + J i^^RjjJd - (e^d; + eoCb) (5.108) 

where Y {e,uj,Ud,^d) ^ is a measurable regression matrix, and 6 is 
the vector of unknown constant inertia parameters introduced in (5.42). 
Since the torque transmission matrix A introduced in (5.98) and given in 
(5.107) is nonsquare, a pseudo-inverse of A must be used. Speciflcally, the 
pseudo-inverse of A, denoted by A"*” G is deflned as follows 

A"^ = A^ {AA^) ^ such that AA“^ = J 3 (5.109) 

where In denotes the n x n identity matrix. As shown in [28], the pseudo- 
inverse given in (5.109) satisfles the Moore-Penrose Conditions given below 



AA+A = A A+AA+=A+ 
(A+A)^ = A+A = AA+. 



(5.110) 



'^The negative sign in (5.106) exists because the coordinates of (5.17) are expressed 
in terms of the body-fixed coordinate frame rather than the inertial reference frame. 
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In addition, the matrix In — A~^A, which projects vectors onto the null 
space of A, satisfies the following properties 

{In - A+A) {In - A+A) =In- A (/„ - A+ A) =0 

{In-A+Af = {In-A+A) {In-A+A)A+ = 0. ’ 

Based on the structure of (5.107) and the subsequent stability analysis, 
the fiywheel torque control input is designed as follows 



Tf = A'^Uc + {In - A'^A) g 
where Uc{t) E is defined as follows 

Uq — 0 I^2V AJ fU) j 



(5.112) 



(5.113) 



and g (t) E is an auxiliary function that will be designed to facilitate the 
energy/power tracking objective. In (5.113), K 2 E R^^^ denotes a constant 
positive-definite diagonal control gain matrix, and the parameter estimate 
6{t) E R^ is generated via the following gradient adaptive update law 



e= ry^ 



V 



(5.114) 



where F E R^^® denotes a constant positive-definite diagonal adaptation 
gain matrix. The subspace of the control input vector r/ (t) that lies in the 
range space of the torque transmission matrix A can be used for attitude 
control, while the remaining degrees of freedom of the flywheel cluster can 
be used to track a desired energy or power profile. That is, since the vector 
{In — A~^A) g{t) lies in the null space of the torque transmission matrix, 
g{t) will be subsequently designed independently of the attitude controller 
in order to track the desired energy/ profile. After substituting (5.112) and 
(5.113) into (5.107), the following closed-loop dynamics for ri(t) can be 
obtained 

jfj = -K2rj + ye-ey (5.115) 

where (5.109), (5.111), and (5.116) have been utilized, and 0{t) E R® de- 
notes the following parameter estimation error 

e = e-k (5.116) 

To develop the closed-loop dynamics for the power tracking error, we 
substitute the time derivative of (5.100) into (5.103) for E{t) as follows 

VE = Pd-^^'fTf 



(5.117) 
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where (5.99) has been utilized. After substituting (5.112) into (5.117), the 
following expression can be obtained 

f]^ = Pd- uj'fA'^Uc - uj'f [In - A~^A) g. (5.118) 

Based on the structure of (5.118), the signal g{t) must be designed to 
satisfy the following equation 

CJy [In - A'^A) g = Pd- luJA'^Uc + (5.119) 

where kE € R is a constant positive control gain. Based on the Moore- 
Penrose pseudo-inverse properties introduced in (5.111), the minimum norm 
solution of (5.119) is given by the following expression 

g= {In- A~^A) U!f [wj {In - A'^A) Wf] ^ {Pd - UjjA'^Uc + kEVE) ■ 

(5.120) 

The solution given in (5.120) exists if [In — A'^A)ujf ^ 0, which implies 
that oof{t) 0 and that ujf{t) is not included in the null space of In — A'^A. 
The control singularity in (5.120) is similar to the one encountered in [38]. 
As noted in [38] , the practical implication of this singularity to the IPACS is 
that the controller will lose the capability to track the desired energy /power 
function. One method to avoid this problem is the singularity-avoidance 
scheme described in [38]. After substituting (5.120) into (5.118) for g[t) 
the following closed-loop error system can be obtained 

Ve — ~kEVE' (5.121) 

5.3.4 Stability Analysis 

Given the adaptive tracking controller of (5.112), (5.114), and (5.120), as- 
ymptotic attitude tracking and exponential energy/power tracking can be 
obtained as described by the following theorem. 

Theorem 5.3 The flywheel torque control input of (5.112), (5. Ilf), and 
(5.120) ensures asymptotic attitude tracking in the sense that 

lime^(t)=0 (5.122) 

t—^oo 

and exponential energy/power tracking in the sense that 

Ve{'I^) = Ve{^) exp {-kEt) . (5.123) 

Proof: Based on the differential expression given in (5.121), Lemma 
A. 10 of Appendix A can be used to prove that t]e [t) G Coo and that 
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the exponential energy/power tracking result given in (5.123) is obtained 
with a rate of convergence that can be made arbitrarily fast by adjusting 
the control gain To prove the asymptotic attitude tracking result of 
Theorem 5.3, we define the nonnegative function V{t) G R as follows 

V = {So- if + e^e^ + ^ri'^Jri + (5.124) 

After taking the time derivative of (5.124) and utilizing (5.15), (5.16), 
(5.114), and (5.115), the following negative semi-definite expression can 
be obtained after algebraic simplification 



V = -elKie,-rfK2V- (5.125) 

Based on the structure of (5.124) and (5.125), 6{t) G Coo and e^(^), rj{t) G 
Coo n C 2 (See Lemma A. 11 of Appendix A). Based on the fact that 6y(t), 
rj{t), 6{t) G £ooj (5.12), (5.34), (5.104), and (5.116) can be used to prove 
that R{t)^ 6{t) G Coo- The expressions given in (5.15-5.17) can be 

used to determine that Co(t), ey{t), uo{t) G Coo- Based on the fact that 
G C 001 and due to the assumption that Edit) G Coo-, (5.100) and 
(5.102) can be used to prove that E{t), cj/ (t) G Coo- From the previous 
boundedness statements, (5.108) can now be used to prove that Y (t) G Coo- 
Hence, from (5.113), Uc{t) G Coo- Dne to the assumption that Pd{t) G £ 00 ? 
(5.120) can now be used to determine that g{t) G Coo if its minimum norm 
solution exists. Hence, from (5.112), r/(t) G Coo- Based on the facts that 
ev(t), ey{t) G Coo and that ey{t) G C 2 , Barbalat’s Lemma (see Lemma A. 16 
of Appendix A) can be invoked to prove asymptotic attitude tracking in 
the sense of (5.122). □ 



5.3.5 Simulation Results 



Numerical simulation results were obtained to validate the adaptive IPACS 
developed in (5.112), (5.114), and (5.120). The inertia matrix for the space- 
craft was selected as follows [38] 

J = diag{200,200,175} [kg-m^j. (5.126) 



The four-flywheel cluster described in [38] was used for the simulation, 
where the flywheel inertia and torque transmission matrix were selected as 
follows 



1 0 
0 1 
0 0 



3 

3 

3 



Jf = 0 . 7/4 [kg • m^] A = 



0 

0 

1 



(5.127) 
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The initial attitude of the spacecraft and the initial angular velocity of the 
flywheels were set as follows 

g„(0) - 1, 9,(0) = [0,0,0]^, (5.128) 

cjf{0) ^ [100, 100, 100, 100]^ [rad -s-i]. 



The desired angular velocity of with respect to I expressed in J^d was 
selected to be a smooth rotation as follows 



(t) = 



3.33 X 10 ^exp (—1.6 x 10 
3.33 X 10”^ exp (—1.6 x 10~H) 
3.33 X 10-3 exp (-1.6 x 10“^^) 



[rad • s ^]. 



(5.129) 



The desired quaternion is related to ujd {t) through the differential equations 
introduced in (5.9) and (5.10). The expressions given in (5.9) and (5.10) 
were integrated with Ud (t) of (5.129) and the following initial conditions 

9„d(0) = 0.9998 and 9,^(0) = [0.01, -0.01,0.01]^ (5.130) 



to obtain the desired attitude trajectory in terms of the quaternion para- 
meterization. 



(a) 




(b) 




(c) 




(d) 




FIGURE 5.7. (a) Desired power profile Pd (solid line) and actual power P (dashed 
line), (b) desired energy profile Ed (solid line) and actual energy E (dashed line), 
(c) power tracking error and (d) energy tracking error 
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FIGURE 5.8. Attitude tracking error (t). 







FIGURE 5.9. Control torque input t/ (t). 
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FIGURE 5.10. Flywheel angular velocity Uf (t). 
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FIGURE 5.11. Elements 2, 3, and 5 of the parameter estimate vector 0(t). 
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To simulate the energy management function of the IPACS, a desired 
power profile similar to the one considered in [38] was used. The desired 
energy/power profiles are shown in Figure 5.7. The desired energy/power 
profiles represent the requirements of a spacecraft undergoing a 100 [min] 
orbit with a sunlight duration of 66 [min] and an eclipse duration of 34 
[min]. During the sunlight period the flywheels are charged by the solar 
panels (i.e., Pd{t) > 0) to supply the energy/power needs of the spacecraft 
during the eclipse period (i.e., Pd(t) < 0). 

The control and adaptation gains in (5.112), (5.114), and (5.120) were 
selected as follows 

Ki=K 2 = 10 "^/ 3 , ke = 10“^ and T = lO/e- (5.131) 

The parameter estimate vector 6{t) was initialized to 50% of the actual 
parameter values. The simulation results are depicted in Figures 5.7-5.11 
over approximately three orbits of the spacecraft. Specifically, the actual 
energy/power are shown in Figure 5.7, along with their respective desired 
profiles. The energy/power tracking errors are also shown in Figure 5.7. 
The attitude tracking error e^(t) is depicted in Figure 5.8 while the control 
torque Tf{t) is shown in Figure 5.9. The flywheel angular velocity a;/ (t) and 
some of the elements of the parameter estimate vector 6{t) are depicted in 
Figures 5.10 and 5.11, respectively. 



5.4 Formation Flying 

MSFF refers to collaborative clusters of interdependent microsatellites that 
talk to each other and share data processing, payload, and mission func- 
tions. These satellites flying in formation are smaller, lighter, less expensive 
to launch, and offer more immediate information-gathering versatility. They 
also cost less than current satellites because they can be mass produced and 
placed in orbit using smaller launch vehicles. As mentioned earlier, forma- 
tion flying permits scientists to obtain comprehensive data by combining 
measurements from several microsatellites. 

For ease of presentation, the adaptive MSFF controller developed here 
is based on simplified system dynamics that model the spacecraft as point- 
masses (i.e., the spacecraft attitude dynamics are neglected). As a result, 
only a translational position controller is required. A more complete de- 
scription of MSFF would not only use the attitude dynamics of the space- 
craft but also the nonlinear couplings between the translational and at- 
titude dynamics. The resulting six degree-of-freedom coupled nonlinear 
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equations of motion would then dictate the development of a control system 
where the torque and force inputs must be designed in tandem to accurately 
control the translation and orientation of the follower spacecraft relative to 
the leader spacecraft. 

This section focuses on the full nonlinear dynamics describing only the 
relative positioning of MSFF for control design purposes. Using Lyapunov- 
based control design and stability analysis techniques, we develop a non- 
linear adaptive control law that guarantees global asymptotic convergence 
of the spacecraft relative position to any sufficiently smooth desired trajec- 
tory, despite the presence of unknown constant or slow varying spacecraft 
masses, disturbance forces, and gravity forces. In the case when the pa- 
rameters are exactly known, the control strategy yields global exponential 
convergence of the tracking errors. As in [16, 40, 41], we will consider in this 
section the idealized scenario where the spacecraft actuators are capable 
of providing continuous-time control efforts, as opposed to being of pulse 
type [20]. 

5.4.1 System Model 

In this section,^ the MSFF fleet is assumed to be composed of two space- 
craft: a leader spacecraft that provides the reference motion trajectory and 
a follower spacecraft that navigates in the neighborhood of the leader space- 
craft according to a desired relative trajectory. The leader spacecraft is 
assumed to be in orbit around the earth with a constant angular velocity 
uj. A schematic representation of the MSFF system is depicted in Figure 
5.12 where the following considerations are made: (i) the inertial coordinate 
system I is attached to the center of the earth, (ii) p{t) G denotes a po- 
sition vector from the origin of the inertial coordinate system to the leader 
spacecraft, (iii) the coordinate frame C is attached to the leader spacecraft 
with the X£-ax.is pointing in the opposite direction as the tangential veloc- 
ity, the y£-axis aligned in the direction of p(t), and the z^-axis is mutually 
perpendicular to the X£ and y£ axes, and (iv) qx{t) G R^ is expressed in X 
and denotes the relative position vector from C to the origin of the follower 
spacecraft coordinate system denoted by T. 

The nonlinear position dynamics of the leader and follower spacecraft 
with respect to X can be developed as follows [20, 39] 

mip + mi{M + rri()G--^ Fde-ui, (5.132) 



^The control development in this section can be easily extended to the case of an 
arbitrary (possibly non-Keplerian) motion of the leader spacecraft. 
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FIGURE 5.12. Schematic representation of the MSFF system. 

mj (p + gj) + m/ (M + m/)G 3 + F^f =Uf. (5.133) 

Up + 9x11 

In (5.132) and (5.133), rrif G M denote the masses, Fdi, Fdf G de- 
note disturbance force vectors, and Ui{t) = [uix U£y Uf{t) G 

denote control input vectors of the leader and follower spacecraft, respec- 
tively, M G R denotes the earth’s mass, and G G R denotes the universal 
gravity constant. In practice, the spacecraft masses vary slowly in time due 
to fuel consumption and payload variations. The disturbance forces also 
slowly vary in time because of solar radiation, aerodynamics, and magnetic 
fields [16]. Given the slow time- varying nature of these parameters, the 
subsequent development is based on the assumption that m^, m/, Fd£^ Fdf 
remain constant. Since M >> (5.132) and (5.133) can be simplified 

as follows 

mep -h rneMG-^ + Fdi = U£ (5.134) 

IIpII 

mf + +Fdf^Uf. (5.135) 

Up + 9x11 

After solving (5.134) for p{t) and then substituting the result into (5.135), 
the following dynamic equation can be determined, which describes the 
position of F relative to G, expressed in 2", 

mfqj+mfMG\ /^-'^^ - ^ = u;. (5.136) 

V Up + 9x11 IIpII / 

To rewrite (5.136) in terms of the moving coordinate system £, the dy- 
namics for qx{t) must be written in terms of £. Since qx{t) is a time- 
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varying vector in J, and the coordinate frame C is moving relative to J, 
the second time derivative of ^x(t) expressed in C (henceforth denoted by 
q{t) — [x y zY') is given by the following expression [36] 
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(5.137) 



where the fact that a; is a constant angular acceleration was used. The first 
term in (5.137) represents the centripetal acceleration, the second term 
represents the Coriolis acceleration, and the last term represents the lin- 
ear acceleration. After calculating the cross product terms, (5.137) can be 
simplified as follows 



Q = 



X — 2ujy — uP'x 
y 4- 2u)x — iu^y 



(5.138) 






After substituting (5.138) into (5.136), the nonlinear position dynamics of 
the follower spacecraft relative to C can be written as follows 



TTifq Cq N + Fd = Uf. (5.139) 

In (5.139), C{ij) € denotes the following Coriolis-like matrix 



C = 2m fu 



“ 0 
1 
0 



-1 0 ■ 
0 0 
0 0 



(5.140) 



N {q^u^ p,Ui) e denotes the following nonlinear vector 



N = 



mfMG 
mfMG 
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(5.141) 



\\p + q\\ 

and Fd € is the total constant disturbance force vector defined as 

Fd - Fdj - ^Fde (5.142) 

me 



where the fact that p = [0 HpH 0] and is constant (see Figure 5.12) in 
the moving coordinate system C was utilized, and ue{t), Uf{t) are expressed 
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in C. The dynamic model of (5.139-5.142) has the following property which 
will be exploited in the subsequent adaptive control design. 

The dynamic equation given in (5.139) can be linearly parameterized as 

rrif^ + C{u)q + N {q, u, p, ue) Fd ^ W{^,q, q, u, p, ue)9 G 

(5.143) 

where W{^^q^q,Uj p^ue) G R^^® denotes a regression matrix that is com- 
posed of known functions, and ^ G R® is a constant parameter vector. From 
the form of (5.139-5.142), the regression matrix and constant parameter 
vector can be determined as follows 



W = 



- 2ujy - J^x 



f I o • 2 y 1 

+ 2u)x - Uj^y 



\\p + q\\ 



O U£x 10 0 

\\P + Qf 

3 “ 7rji2 0 10 

U£z 0 0 1 



and 



0 



WpfqW^ 



Vflf 



(5.144) 



rrif rrifMG — Fdx Fdy Fdz 
me 



(5.145) 



where Fdx, Fdy, Fdz are the components of the vectors ^ and 

Fd, respectively. 



5.4.2 Control Objective 

Given a desired position trajectory qd{t)e. R^ for the follower with respect 
to the leader (assuming that qd{t) and its first two time derivatives are 
bounded functions of time), the objective of MSFF is to design the con- 
trol input Uf{t) such that the actual position trajectory tracks the desired 
position trajectory. To quantify the MSFF position tracking objective, a 
position tracking error, denoted by e{t) G R^, is defined as follows 

e{t) ^ qd{t) - q{t). (5.146) 

In addition, a filtered tracking error, denoted by r(t) G R^, is defined as 
follows 

r{t) = e{t) ^ ae{t) (5.147) 

to simplify the subsequent control design/analysis, where a G R^^^ denotes 
a constant diagonal positive-definite control gain matrix. The subsequent 
control development is based on the assumption that q{t) and q(t) are mea- 
surable and under the constraint that the spacecraft masses, disturbance 
forces, and gravitational force are unknown. 
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5.4.3 MSFF Control 

To develop the open-loop error system for r(t), we take the time derivative 
of (5.147) and multiply both sides of the resulting equation by my as follows 

m/f = rrif (qd + ae) + C (cj) q -i- N {q,uj, R, ue) + Fd - Uf (5.148) 

where (5.139) and (5.146) were utilized. After using (5.143) and substitut- 
ing the following expression 



^ = qd-\-ae (5.149) 

into the definition of (5.144) for ^(t), the expression given in (5.148) can 
be rewritten £is follows 

rrifr = We-Uf. (5.150) 

Based on the form of the open-loop dynamics of (5.148), the control input 
Uf{t) is designed as follows 

Uf =W{-)e + Kr (5.151) 

where A G is a constant diagonal positive-definite control gain ma- 

trix, and the parameter estimate vector 9(t) is generated by the following 
gradient update law 

0=rw'^{-)r (5.152) 

where F G is a constant diagonal positive-definite adaptation gain 

matrix. After substituting (5.151) into (5.148), the closed-loop dynamics 
for r{t) can be determined as follows 

m/r--iFr + kF(-)^ (5.153) 

where 0{t) G quantifies the difference between the actual and estimated 
parameters as follows 

e{t) = 9 (5.154) 

By differentiating (5.154) and utilizing (5.152), the closed-loop dynamics 
for 9(t) can be determined as follows 

e= -rw'^{-)r. (5.155) 

5.4.4 Stability Analysis 

The MSFF controller given in (5.151) and (5.152) yields global asymptotic 
tracking as described by the following theorem. 
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Theorem 5.4 The adaptive MSFF controller given in (5.151) and (5.152) 
ensures the follower spacecraft globally asymptotically tracks a desired tra- 
jectory with respect to a leader in the sense that 

lim e{t),e(t) = 0. (5.156) 

t — ►CXD 

Proof: To prove Theorem 5.4, we define a nonnegative function V{t) G M 
as follows 

y = (5.157) 

After taking the time derivative of (5.157) and substituting the closed-loop 
dynamics developed in (5.153) and (5.155) into the resulting expression, 
the following expression can be obtained 

y = -r^Kr < -A™„ {K} ||r|p < 0 (5.158) 

where Amin {•} denotes the minimum eigenvalue of a matrix. The expres- 
sions given in (5.157) and (5.158) can now be used to prove that r{t)^9{t) G 
Coo and Lemma A. 11 of Appendix A can be used to prove that r{t) G £2- 
Since r(t) G £00 ? Lemma A. 13 of Appendix A can be utilized to prove 
that e(t), e{t) G £00 • Hence, due to the boundedness of qd{t) and qd{t), the 
definition of (5.146) can be utilized to conclude that g(t), q(t) G £00 • Since 
9(t) G £00 and 0 is a constant vector, (5.154) can be used to determine that 
^(0 ^ ^ 00 • Prom the above boundedness statements and the fact that qd{t) 
is assumed to be bounded, the definitions of (5.144) and (5.149) can be 
used to state that VP (•) G £ 00 • Based on the preceding facts, (5.139) and 
(5.151) can be used to prove that Uf{t), q{t), r(t) G £ 00 - Thus, all signals 
in the adaptive controller and system remain bounded during closed-loop 
operation. Based on the fact that r(t), r(t) G £00 and that r(t) G £2, Bar- 
balat’s Lemma (see Lemma A. 16 of Appendix A) can be invoked to prove 
that 

lim r{t) = 0. (5.159) 

t—*oo 

Based on (5.147) and (5.159), Lemma A. 15 of Appendix A can be applied 
to obtain (5.156). □ 

Remark 5.3 In the case where the parameter vector 9 of (5.1f5) is per- 
fectly known, the control law introduced in (5.151) with 9{t) = 9 (i.e., an 
exact model knowledge controller) could be developed to ensure global expo- 
nential convergence of the position and velocity tracking errors in the sense 
that 



||r(t)||<||r( 0 )||exp 



Amin {K} \ 
mj ) 



(5.160) 
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This result can be proven by defining the following nonnegative function 

V = (5.161) 

and utilizing similar arguments as in the proof of Theorem 5.4 along with 
Lemma A. 14 of Appendix A. 

Remark 5.4 To minimize fuel consumption, many MSFF control systems 
utilize pulse-type actuators (e.g., Hall thrusters and pulse plasma thrusters 
[33]). Hence, the application of continuous-time control inputs in these 
cases for long periods of time is not practical as noted in [39, 43] • This 
constraint would require the implementation of a ^‘pulse-based” version of 
the nonlinear controller developed in (5.151) and (5.152). The effect of 
this noncontinuous nonlinear control law on the closed-loop stability has 
not been considered and constitutes an interesting open problem in MSFF 
control. However, as mentioned in [39], continuous MSFF control laws can 
provide an idealized system response for comparison purposes with the ac- 
tual responses obtained from the noncontinuous implementation of the con- 
trollers. 



5.4.5 Simulation Results 

The adaptive MSFF controller developed in (5.151) and (5.152) was simu- 
lated for the two spacecraft MSFF problem depicted in Figure 5.12, where 
the following parameters were used to define the system [20, 39] 

M — 5.974 X lO^'^ [kg], = 410 [kg], = 1550 [kg]. 



G = 6.673 X 10-11 [kg m^ s2], 

p= [0,4.224 X 10^,0]^ [m], w = 7.272 x IQ-^ [rad-s-i], 



(5.162) 



ue = 0 [N], Fd = [-1.025,6.248, -2.415] x 10“^ [N]. 



The parameter estimates were initialized to 50% of the actual parameter 
values defined in (5.145) and (5.162) (i.e., ^(0) = 0.5^). The desired relative 
trajectory was selected as follows 



qd{t) = 



100 sin (4ujt) (l — exp (—0.05^^)) 
100 cos (4wt) (l — exp (— 0.05t^)) 
0 



[m] 



(5.163) 



where the exponential term was included to ensure that qd{0) — 9 d( 0 ) = 0. 
The relative position and relative velocity were initialized to the following 
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values 

g(0) = [0,0, —200]^ [m] q{0) = 0 [m • s~^] (5.164) 

while the desired trajectory of (5.163) and the initial conditions of (5.164) 
represent a follower spacecraft that is initially stationary with respect to 
the leader spacecraft, and is then commanded to move around the leader 
spacecraft in a circular orbit of radius 100 [m] in the plane formed by the 
X£^y£ axes of C with a constant angular velocity of 4a;. The selection of 
the above desired trajectory does not account for fuel consumption con- 
siderations. However, it illustrates the capability of the controller to track 
demanding trajectories that may occur during formation reconfiguration 
maneuvers. 

After selecting the control and adaptation gains as follows 



A = diag (2, 2,1), K = diag (100, 200, 120) , 
r = diag (500, 50, 300, 600, 850, 480) 



(5.165) 



the resulting position tracking error illustrated in Figure 5.13 was obtained. 
The phase portrait of the trajectory q(t) of the follower spacecraft relative 
to the leader spacecraft is illustrated in Figure 5.14 where * represents the 
leader spacecraft at the origin. The control input Uf{t) is given in Figure 
5.15, while four sample components of the parameter estimate vector 6{t) 
are presented in Figure 5.16. 



5.5 Background and Further Reading 

Several solutions to the attitude control problem have been presented in 
the literature since the early 1970s [27]. See [42] for a comprehensive lit- 
erature review of earlier work. The authors of [42] presented a general 
attitude control design framework which includes linear, model-based, and 
adaptive set-point controllers. Adaptive tracking control schemes based on 
three-parameter, kinematic representations were presented in [32, 35] to 
compensate for the unknown spacecraft inertia matrix. In [1], an adaptive 
attitude tracking controller based on the unit quaternion was proposed 
that identified the inertia matrix via periodic command signals. The work 
of [1] was later applied to the angular velocity tracking problem in [2]. An 
Hoo-suboptimal state feedback controller was developed for the quaternion 
representation in [11]. In [22], the authors designed an inverse optimal con- 
trol law for attitude regulation using the backstepping method for a three- 
parameter representation. The authors of [5] recently presented a variable 
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FIGURE 5.13. Position tracking error e{t). 
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FIGURE 5.14. Trajectory of follower spacecraft relative to leader spacecraft (* 
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FIGURE 5.15. Control input Uf (t). 



Theta -hat(1) 





Time (hours) 




FIGURE 5.16. Sample of parameter estimates. 
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structure tracking controller using quaternions in the presence of spacecraft 
inertia uncertainties and external disturbances. 

A typical feature in all the above-mentioned attitude control schemes is 
that angular velocity measurements are required. Unfortunately, this re- 
quirement is not always satisfied in reality. Thus, a common practice is 
to approximate the angular velocity signal through an ad hoc numerical 
differentiation of the attitude angles, and directly use this surrogate signal 
for control design with no guarantee of closed-loop stability. With this in 
mind, an angular velocity observer was developed in [31] for the quaternion 
representation. However, the observer was based on an unproven separa- 
tion principle argument. In [26], a passivity approach was used to develop 
an asymptotically stabilizing setpoint controller that eliminated velocity 
measurements via the filtering of the unit quaternion. The passivity-based 
velocity-free setpoint controller of [26] was later applied to the simpler, 
three-parameter problem in [37]. Wong, de Queiroz, and Kapila [43] re- 
cently proposed an adaptive attitude tracking controller without angular 
velocity measurements using the modified Rodrigues parameters. In [10], 
Costic et al. proposed an output feedback quaternion-based attitude track- 
ing controller. 

A comprehensive literature review of the IPACS concept is presented in 
[17]. As noted in this work, the IPACS concept has been investigated since 
the 1970s [3]. However, the enabling technologies have only recently reached 
a level of maturity that facilitates on-board evaluation. Also noted in [17] is 
that most control designs for the IPACS problem are based on linearization 
of the spacecraft dynamic equation. With this fact in mind, Tsiotras, Shen, 
and Hall [38] used the nonlinear dynamic equation presented in [17] along 
with a modified Rodrigues parameters-based kinematic representation to 
design an attitude and power tracking control scheme using an array of 
reaction wheels. Recently, Fausz and Richie [14] extended the approach of 
[38] for flywheels operating in a variable-speed control moment gyro mode. 
To compensate for parametric uncertainty in the spacecraft inertia (the 
IPACS results of [14, 38] require exact knowledge of the spacecraft inertia), 
adaptive attitude controllers were developed in [1, 5, 10, 32, 43]. However, 
these results do not deal with the problem of simultaneous attitude and en- 
ergy/power tracking, and hence, do not account for the flywheel dynamics. 
A recent result that does address simultaneous attitude and energy/power 
tracking while accounting for the flywheel dynamics is given in [9]. 

The interest demonstrated by NASA and the U. S. Air Force has led to 
several studies on autonomous MSFF reported in the literature. For ex- 
ample, in early research, [39] presented the concept of formation keeping 
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of spacecraft for a ground-based terrestrial laser communication system, 
whereas [29] considered station keeping for the space shuttle or biter. Re- 
cently, [24] considered MSFF control for NASA’s NMI mission using sep- 
arated spacecraft interferometry. Similarly, [15] considered MSFF control 
for NASA’s EO-I mission which was scheduled to demonstrate a stereo 
imaging concept in 1999. 

The practical implementation of the MSFF concept relies on the accurate 
control of the relative positions and orientations between the participating 
spacecraft for formation configuration and collision avoidance. Most MSFF 
control designs utilize simplifying modeling assumptions to aid the con- 
trol synthesis due to inherent difficulties associated with the structure of 
the full nonlinear dynamic model of MSFF. These simplifications result 
in the well-known Clohessy- Wiltshire linear dynamic equations [7, 8, 20] 
for the relative positioning of MSFF. The Clohessy-Wiltshire model has 
formed the basis for the application of various linear control techniques to 
the MSFF position control problem [20, 25, 29, 39]. Reviewing the current 
state of MSFF control, it seems that in contrast to linear control, non- 
linear control theory has not been exploited to its full potential. A few 
results investigating nonlinear control of MSFF can be found in [16, 40, 41] 
using a Lyapunov- based approach. In particular, [40] designed a class of 
control laws based on exact knowledge of the MSFF model that yielded lo- 
cal asymptotic position tracking and global exponential attitude tracking. 
The application of the controllers proposed in [40] to formation rotation of 
MSFF about a given axis and synchronization of individual spacecraft ro- 
tation was later reported in [41]. More recently, [16] developed an adaptive 
position controller that compensated for unknown constant disturbances 
while producing globally asymptotically decaying position tracking errors. 
This controller, however, required exact knowledge of the spacecraft pa- 
rameters. Recently, a nonlinear adaptive relative positioning controller for 
MSFF was developed in [13] despite parametric uncertainty in the space- 
craft dynamics. As an endnote, the problem of pulse- type nonlinear control 
design for MSFF constitutes an open research problem which is being in- 
vestigated. 
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6 

Underactuated Systems 



6.1 Introduction 

The engineering systems described in the previous chapters are fully actu- 
ated (the number of control inputs (actuators) equal the number of degrees 
of freedom). However, because of actuator failures or various construction 
constraints some apphcations are underactuated (the degrees of freedom 
exceed the number of control inputs). Underactuated systems present chal- 
lenging control problems since the control design must typically exploit 
some coupling between the unactuated states and the actuated states to 
achieve the control objective. In the subsequent sections, the particular 
control issues related to the underactuated nature of several engineering 
applications are examined. 

The first underactuated application examined in this chapter is an over- 
head crane system. The control of overhead crane systems has been a heav- 
ily investigated problem due to both the theoretical challenges and the prac- 
tical importance. Specifically, precise payload positioning by an overhead 
crane is difficult because the payload can exhibit a pendulum-like swinging 
motion. These payload swings can result in several performance and safety 
concerns including (i) payload damage, (ii) damage to the surrounding en- 
vironment or personnel, and (iii) large internal forces that can result in 
reduced payload-carrying capacity or premature failure of stressed parts. 
Motivated by the desire to achieve fast and precise payload positioning 
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while mitigating the above performance and safety concerns, in the first 
section of this chapter, a linear controller is proven to yield asymptotic 
regulation of the underactuated payload and 2 degree-of-freedom (2-DOF) 
gantry dynamics of an overhead crane. Specifically, a linear feedback loop 
at the gantry creates an artificial spring/damper system that absorbs the 
payload energy. Utilizing LaSalle’s Invariant Set Theorem, the linear con- 
troller is proven to asymptotically regulate the overhead crane dynamics. 
Motivated by the heuristic concept that improved coupling between the 
gantry and the payload dynamics will provide a mechanism for improved 
transient response, two nonlinear energy-based coupling control laws are 
then designed by incorporating additional nonlinear feedback terms with 
the linear controller. Experimental results illustrate that the increased cou- 
pling of the nonlinear controllers results in improved transient response 
(e.g., reduced overshoot and faster settling time) over the linear control 
law. 

Over the last decade, there has been considerable interest in designing 
controllers for vertical take-off and landing (VTOL) aircraft. The VTOL 
control problem is complicated by the fact that the underactuated dynam- 
ics are nonlinear, nonminimum-phase, and subject to nonholonomic (non- 
integrable) constraints. Moreover, it has been acknowledged that standard 
techniques to decouple the rolling moment and the lateral acceleration, 
such as static input-output linearization approaches, fail to produce satis- 
factory performance, since input-output linearization often results in the 
unstable roll dynamics being unobservable (see [25]). In the second sec- 
tion of this chapter, a reference trajectory generator and a global invertible 
transformation are developed to rewrite the VTOL kinematics in a similar 
form as Brockett’s Nonholonomic Integrator [9]. Based on the structure of 
the transformed dynamics, a dynamic oscillator-based control strategy is 
developed. The approach uses a series of transformations to manipulate 
the VTOL dynamics into a suitable form which allows a Lyapunov-based 
controller to be designed. The resulting position and attitude tracking and 
regulation errors of the VTOL aircraft are proven to be globally uniformly 
ultimately bounded (GUUB) to a neighborhood that can be made arbi- 
trarily small. Extensions are also provided to illustrate how the open-loop 
error systems of an automotive steering problem and an underactuated 
surface vessel problem can be expressed in a similar form to Brockett’s 
Nonholonomic Integrator, allowing similar control designs to be developed. 

Over the past ten years, the attitude control of rigid body systems has 
become an active area of research. Among its many applications are the 
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attitude control of rigid aircraft and spacecraft^ systems (the interested 
reader is referred to [54] for a literature review of the many different types 
of applications). Rigid spacecraft applications are often required to per- 
form highly accurate slewing and/or pointing maneuvers that force the 
spacecraft to rotate along a relatively large amplitude trajectory. These 
performance requirements mandate that the control design be predicated 
on the use of the nonlinear spacecraft model [1]. This nonlinear model is 
typically represented by Euler’s dynamic equation, which is used to de- 
scribe the time evolution of the angular velocity vector, and the kinematic 
equation, which relates the time derivatives of the orientation angles to the 
angular velocity vector. In the third section of this chapter, the satellite 
kinematics are formulated in terms of the constrained unit quaternion as 
a means to express the spacecraft attitude without singularities. Based on 
the form of the underactuated satellite kinematics, a similar (quaternion- 
based) dynamic oscillator control structure is also developed to achieve 
uniformly ultimately bounded (UUB) tracking and regulation provided a 
sufficient condition is satisfied based on the initial conditions of the system. 
As an extension to the design, an integrator backstopping technique is used 
to incorporate the dynamic model of an axisymmetric satellite. 



6.2 Overhead Crane Systems 

In this section, a linear controller and two nonlinear coupling control laws 
are developed for an overhead crane system with a 2-DOF gantry. By uti- 
lizing a Lyapunov-based stability analysis along with LaSalle’s Invariance 
Set Theorem, asymptotic regulation of the gantry and payload position is 
proven for the controllers. 

6.2.1 System Model 

The dynamic model for the underactuated overhead crane system given in 
Figure 6.1 is assumed to have the following form [42] 

M{q)q + Vm{q,q)q + G{q)-=u. ( 6 . 1 ) 

In (6.1), M{q) G Vm(q,q) £ R'^^'*, and G{q) € R^, represent the 

inertia, centripetal-Coriolis, and gravity terms (for details regarding the 
components of these matrices see Definition B.3 of Appendix B), respec- 
tively, g(t), q(t) G R^, represent the first and second time derivatives of 



^ As in previous chapters, the words spacecraft and satellite are used interchangeably. 
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FIGURE 6.1. 3-DOF overhead crane system. 
q{t) G that is defined as follows 

q-[x y e (f)Y (6-2) 

where x{t), y{t) G R denote the Cartesian coordinates of the gantry with 
respect to a fixed inertial reference frame, 6{t) G R denotes the payload 
angle with respect to the vertical, G R denotes the projection of the 
payload angle along the X-coordinate axis, and u{t) G R^ is defined as 

u^[F^ Fy 0 0]^ (6.3) 

where Fx{t), Fy(t) G R represent the control force inputs acting on the 
cart and rail, respectively. The dynamic model given in (6.1) exhibits the 
following properties that are used in the subsequent control development 
and stability analysis. 

Property 6.1: Symmetric and Positive-Definite Inertia Matrix 

The symmetric and positive-definite inertia matrix M (q) satisfies the 
following inequalities 

ki < ^^M(q)^ < k2 lien" ve € (6.4) 

where /ci, A :2 G R are positive bounding constants, and H-H denotes the 
standard Euclidean norm. 
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Property 6.2: Skew- Symmetry 

The inertia and Coriolis matrices satisfy the following skew-symmetric 
relationship 

f e = 0 e (6.5) 

where M(g) denotes the time derivative of the inertia matrix. 

In a similar manner as in [10, 37], the dynamic model given in (6.1) is 
assumed to have the following characteristics. 

Assumption 6.1: The payload and the gantry are connected by a mass- 
less rigid link. 

Assumption 6.2: The angular position and velocity of the payload and 
the planar position and velocity of the gantry are measurable. 

Assumption 6.3: The gantry mass and the length of the connecting rod 
are known. 

Assumption 6.4: The connection between the payload link and the gantry 
is frictionless and does not rotate about the connecting link (i.e., the 
payload does not rotate about the link axis). 

Assumption 6.5: The angular position of the payload mass is restricted 
according to following inequalities 

-7T < 6{t) < 7T (6.6) 

where 6{t) is measured from the vertical position (see Figure 6.1). 

Remark 6.1 The model given by (6.1) could be modified to include other 
dynamic effects associated with the gantry dynamics (e.g., gantry friction, 
viscous damping coefficients, mass moment of inertia of the gantry and 
rail motors). However, these additional dynamic effects were not included 
in the model since these effects can be directly cancelled by the controller. 

6.2.2 Open-Loop Error System 

To express the dynamic model in a form that facilitates the subsequent 
control development and stability analysis, both sides of (6.1) are premul- 
tiplied by M~^{q) to obtain the following expression 



q = (u - V^q - G) 



(6.7) 
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where M ^ (g) G is guaranteed to exist since the determinant of M{q ) , 
denoted by det(M), is given by the following positive function 

det(M) = {rrip + rric) {rup + rrir + rUc) 

-\-rripL?I [(rUp + -f Trie) rric (l + sin^ 6) 

+ {rrip + rric) rrip sin^ 6 + uirTrip (sin^ 0 + 2 sin^ 6 cos^ 0)] 

+m^L'^ sin^ 9 ( {rnririp sin^ 9 cos^ 0) 

+ rric [rrir + + rrip sin^ 9) ) . 

( 6 . 8 ) 

In (6.8), the parameters rrip, rrir, rric G R represent the payload mass, rail 
mass, and cart mass, respectively, 7 G R denotes the moment of inertia of 
the payload, L G R represents the length of the crane rod, and p G R repre- 
sents the gravity constant. After performing some algebraic manipulation, 
the first two rows of (6.7) can be expressed as follows 

^ ~ det(M) -^Vi 2 Fy + wi) (6.9) 

y = + P22Fy + W2) ( 6 . 10 ) 

where the measurable terms pn(g), Puiq), P22{q), '^i(<?,7), '^2{qA) ^ 
are defined as follows 

Pii = rUpL'^I (sin^ 0 + 2 sin^ 9 cos^ 0) + mpP + rricmpL'^ sin^ 9 
-\-mcmpL^ I (l + sin^ 9) + rricP + cos^ 0sin^ 9 

( 6 . 11 ) 

Pi 2 = — mp7y^sin0cos0sin^0 — TUpL^/sin 0cos 0 (sin^^ — cos^ 9) (6.12) 

P22 = sin^ 9 sin^ 0 + rripL‘^1 [l + (sin^ 9 - cos^ 9) sin^ 0] 

+ (rrip + rrir + rric) 7^ + (rrir + rric) sin^ 9 (6.13) 

+ (rrir + rric) rripL‘^1 (l + sin^ 9) 
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Wi = rripL sin 6 sin 0 [(mp + me) I + mpiricL^^ sin^ 9\ 

{rripLP' sin^ 9 1) 0^ {iripLP' + /) 

— 21 rripLO^ cos 9 cos (f) [{rrip + rric) I + mpL‘^ (rric + rrip sin^ 9)] 
-{-rUpgL^ sin 9 cos 9 sin cj) [(m^ + rUc) I + mpmcL"^ sin^ 9] 

(6.14) 



W 2 = rUpL sin 9 cos (j) [{rrip + rur + rric) I + {rrir + rric) rripL^ sin^ 

[(P {rripL? sin^ 9 ^ l) {rripL? + /)] 

-]-2mpLI9(j) cos 9 sin 0 [{rup + m^ + rUc) {rripL^^ + cos^ 0] 

-hrUpgL sin 9 [{rrir + rric) rn^L^ sin^ 9 cos 9 cos (f) 



+ {rrir + rric + rrip) rripLI cos 9 cos 4>] . 

(6.15) 

To write the open-loop dynamics given in (6.9) and (6.10) in a more 
compact form for the subsequent control development, the composite vector 
r{t) G M? is defined as follows 

r = [ X y ]'^ ■ (6.16) 

After taking the second time derivative of r{t) and then utilizing the ex- 
pressions given in (6.9-6.15), the open-loop dynamics given in (6.9) and 
(6.10) can be expressed as follows 

’'= 1 * = 

where P{q) G and W{q,q) G are defined as follows 



p = 


' Pll 


P12 ' 


w = 


' Wi 




. P12 


P22 




W2 



and F{t) G M? is defined as 

F=[F, Fy]" (6.19) 

where Pij{q), Wi{q) for ij = 1,2 are given in (6.11-6.15). Given the ex- 
pressions in (6.11-6.13), it is straightforward to prove that 

Pii > 0 and P 11 P 22 - P 12 > 'Trip (^p + m^ + rric) (6.20) 
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and hence, (6.18) and (6.20) can be used to prove that P(g) is positive- 
definite symmetric and invertible,^ where the inverse of P(g), denoted by 
P“^(g), is also positive-definite and symmetric. 

To facilitate the subsequent Lyapunov-based control design and stability 
analysis, the potential and kinetic energy of the overhead crane system 
is determined. Specifically, the total energy of the overhead crane system, 
denoted by E{q, q) € R, is given as follows 

E{q, q) = \(FM{q)q + mpgL{\ - cos(0)) > 0. 

' , ' ' - ' (g_2i) 

Kinetic Potential 

Energy Energy 

After taking the time derivative of (6.21), substituting (6.1) for M{q)q(t), 
and cancelling common terms, the following expression can be obtained 

E = r^F (6.22) 

where (6.2), (6.5-6.16), (6.19) and Definition B.3 of Appendix B were uti- 
lized. 

6.2.3 Control Design and Analysis 

The control objective of this section is to regulate the planar gantry position 
of the overhead crane to a constant desired position, denoted by G R^, 
which is explicitly defined as 



Td = [xd Vdf (6.23) 

while simultaneously regulating the payload angle 6(t) to zero. To quan- 
tify the objective of regulating the overhead crane to a constant desired 
position, a gantry position error signal, denoted by e{t) G R^, is defined as 
follows 

e{t) = r -Td. (6.24) 

Remark 6.2 As in [42], the crane dynamic model given in (6.1) exploits 
a projection of the payload angle along the X -coordinate axis, denoted by 
(j){t). By injecting this artificial state, the dynamic model can be written 
in a manner that facilitates the development of controllers that achieve 



^The expression given in (6.18) and the fact that P{q) is a leading minor of the 
positive-definite matrix M~^ (q) could also be used to conclude that P{q) is positive- 
definite, symmetric, and invertible [27]. 
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the control objective. Unfortunately ^ the overall stability analysis is com- 
plicated by the fact that an additional unactuated state is injected into the 
system. From a physical standpoint, if the payload angle, denoted by 0{t), 
is regulated to zero, then from Figure 6.1, the payload is regulated to the 
desired location, and hence, the control objective is not defined in terms of 
regulating (f{t). 

Linear Control Law 

A linear control lav^ for the overhead crane system can be designed as 
follows 

F = (kdr kpe) (6.25) 

ke 

where kd, kE, kp G M are positive constant control gains. The linear con- 
trol law given in (6.25) yields asymptotic regulation of the overhead crane 
system as stated in the following theorem. 

Theorem 6.1 The linear control law given in (6.25) ensures asymptotic 
regulation of the overhead crane system in the sense that 

^Um ( x{t) y{t) 6{t) ) = { yd 0 ) (6.26) 

where Xd and yd were defined in (6.23). 

Proof: To prove Theorem 6.1, we define a nonnegative function T/(t) G M 
as follows 

V — kEE -h -kpe^e. (6.27) 

The time derivative of (6.27) can be obtained as follows 

V = r^ (kEF -h kpe) (6.28) 

where (6.22) and the time derivative of (6.24) were utilized. After substi- 
tuting (6.25) into (6.28) for F(t) and then cancelling common terms, the 
following expression is obtained 

V = -kdr^r. (6.29) 

Based on the expressions given in (6.4), (6.21), (6.24), (6.27), and (6.29), 
it is clear r{t),e{t),q{t) G Coo- Based on the fact that r{t),e{t),q{t) G Coo, 
( 6 . 2 ) and (6.16) can be used to show that x{t), x{t), y{t), y{t), r(t), 6{t), 
^ Coo- Given that e(t), r{t) G £005 (6.25) can be used to determine 
that F{t) G Coo- The expressions given in (6.3) and (6.19) can now be used 
to determine that Fx{t), Fy{t),u{t) G Coo- 
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Based on the fact that all of the closed-loop signals remain bounded, 
LaSalle’s Invariance Theorem (see Lemma A. 22 of Appendix A) can now 
be used to prove (6.26). To this end, the set F is defined as the set of all 
points where 

V = 0. (6.30) 

In the set F, we see from (6.29) and (6.30) that 

r{t) = 0 r{t) = 0, (6.31) 

and hence, (6.16), (6.27), (6.30), and (6.31) can be used to determine that 
x(t), y{t), and V{t) are constant. Furthermore, from (6.22), (6.24), and 
(6.31), we see that 

E{q,q) = e{t)=0. (6.32) 

Based on (6.32), we see that E{q, q) and e{t) are constant, and hence, from 
(6.25) and (6.31), it is clear that F{t) is constant. To complete the proof, 
stability of the system must be examined for the case when 0 = 0 and when 
0 0. In this analysis, given in Lemma B.21 of Appendix B, the result given 

in (6.26) is proven under the proposition that 0 = 0. Furthermore, Lemma 
B.21 proves the proposition that 0 0 leads to contradictions, and hence, 

is invalid. □ 

The stability analysis for Theorem 6.1 indicates that the control objec- 
tive is met and that all signals in the dynamics and the controller remain 
bounded for all time except for the signal (Note that by assump- 

tion, the payload angle, denoted by 0(t), is assumed to be bounded.) The 
boundedness of <t){t) is insignificant from a theoretical point of view since 
</)(^) only appears in the dynamics and control as arguments of bounded 
trigonometric functions. The stability result for the linear control law (and 
the subsequent coupling control laws) is not considered to be global due to 
Assumption 6.5. However, from a practical standpoint it seems rare that 
the payload of the overhead crane system would need to violate this as- 
sumption. 

Heuristically, the only way for the energy from the payload motion to be 
dissipated is through the coupling between the payload dynamics and the 
gantry dynamics. That is, a linear feedback loop at the gantry creates an 
artificial spring/damper system which absorbs the payload energy through 
the natural gantry /pay load coupling. However, from our experience with 
many control experiments on overhead crane testbeds, we have observed 
that a linear feedback loop at the gantry will always provide poor perfor- 
mance because perfect compensation for the gantry friction is not achieved 
(and it never will be). That is, the uncompensated gantry friction effects 
tend to retard the natural coupling between the gantry/payload dynamics, 
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and hence, prevent payload energy from being dissipated by the linear feed- 
back loop at the gantry. In the following sections, controllers are developed 
that improve the performance of the linear feedback loop at the gantry by 
incorporating additional nonlinear terms in the control law that depend on 
the payload dynamics. Although the subsequent controllers yield the same 
stability result as the linear controller, the increase in gantry /payload cou- 
pling by the additional nonlinear terms results in improved performance 
when compared to the simple linear gantry controller. That is, the sub- 
sequent controllers exploit additional energy-based nonlinear terms that 
provide increased payload swing feedback through the coupling between 
the gantry and the payload. The improved performance of the subsequent 
nonlinear coupling controllers has been demonstrated by simulation results 
and by the experimental results presented in Section 6.2.4. 



Coupling Control Law 

As stated previously, improved performance may result from increasing the 
coupling between the gantry and the unactuated payload. Motivated by the 
desire to increase the gantry /pay load coupling, the following E‘^ coupling 
control law is developed^ 

F = ( 6 . 33 ) 

where n{t) G is a positive-definite invertible matrix^ defined as follows 

kE, kp, kd, ky G M are positive constant control gains, I 2 denotes the stan- 
dard 2x2 identity matrix, and det(M), P{q), and W{q,q) were defined 
in (6.8) and (6.18). The coupling control law given in (6.33) yields as- 
ymptotic regulation of the overhead crane system as stated in the following 
theorem. 



^The control strategy is called an coupling control law because its structure is 
motivated by a squared energy term and an additional squared gantry velocity term in 
the Lyapunov function. The structure of this controller is inspired by the previous work 
given in [35] for an inverted pendulum. 

^Since P and I 2 are positive-definite symmetric matrices, and kE, ky, E{q,q), and 
dei{M{q)) are positive scalars, it can be proven that 0(t) is positive-definite and 
invertible. 




280 



6. Under actuated Systems 



Theorem 6.2 The coupling control law given in (6.33) ensures asymp- 
totic regulation of the overhead crane system in the sense that 

^1^ ( x{t) y{t) e(t) ) = ( Xd yd 0 ) (6.35) 

where Xd and yd were defined in (6.23). 

Proof: To prove Theorem 6.2, we define a nonnegative function V{t) € M 
as follows 

V = ^^eE‘^ -h ^kpc'^e -f (6.36) 

After taking the time derivative of (6.36) and then substituting (6.17), 
(6.22), and the time derivative of (6.24) into the resulting expression for 
r(t), E{q, q), and e(t), respectively, the following expression can be obtained 

where (6.34) was utilized. After substituting (6.33) into (6.37) for F{t) and 
then cancelling common terms, (6.37) can be rewritten as follows 

V = —kdr^r. (6.38) 

Based on the expressions given in (6.6), (6.21), (6.24), (6.36), and (6.38), it 
is clear that r(t), r(t), e(^), q{t)^ E{q,q) G £00 hence, (6.2) and (6.16) 
can be used to determine that x(t), x(t), y{t),y{t),6{t), (j)(t) G £00 • The 
expressions given in (6.8), (6.11-6.15), (6.18), and (6.20) can be used to 
show that det(M(g)), P(g), P"^(g), W{q,q) G £oo- Given (6.206) and the 
fact that E{q^q), P{q) ^ ^ 00 ^ (6.34) can be used to show that fl{t) G £oo- 
Given the following expression for the determinant of Ct{t) 

dem = (kEEf + {pn +P22) + ( 5 ^) ~Pi^) 

(6.39) 

the expressions given in (6.8), (6.11-6.13), (6.20), and (6.21) can be utilized 
to determine that 

det(n) > (^p d-mr+ rric) I*. (6.40) 

Based on the fact that det(M(^)), rt{t) G £ 00 , (6.40) can be used to prove 
that Q~^(t) G £oo- Given that e(t), r{t), det(M(g)), W{q,q), Q~^(t) G Cooy 
it is clear from (6.33) that F(t) G £ 00 • Prom (6.3) and (6.19), Fx{t), Fy{t), 
u{t) G £00 • Since all of the closed- loop signals remain bounded and the 
time derivative of (6.36) is decreasing or constant as indicated by (6.38), 
Lemma B.22 of Appendix B can be used to prove Theorem 6.2. □ 
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Gantry Kinetic Energy Coupling Control Law 

To illustrate how additional controllers can also be derived to increase 
the gantry /pay load coupling, the following gantry kinetic energy coupling 
control law is designed^ 



F = 



-kdv - kpe - kyP-^W - a (det(M)P-i)) ■ 

ky 



(6.41) 



where kE, kp, kd, and ky ^ are positive constant control gains, and 
det(M), P{q), and W{q^q) were defined in (6.8) and (6.18). The gantry 
kinetic energy coupling control law given in (6.41) yields asymptotic regu- 
lation of the overhead crane system as stated in the following theorem. 

Theorem 6.3 The gantry kinetic energy coupling control law given in 
(6.41) ensures asymptotic regulation of the overhead crane system in the 
sense that 

lim ( x{t) y(t) 9(t) ) = { Xd yd 0 ) (6-42) 

t — ►OO 

where Xd and yd were defined in (6.23). 

Proof: To prove Theorem 6.3, we define a nonnegative function V{t) G K 
as follows 

V = kEp + ^kyr^ (det(M)P“^) r -f \-kpe^ e. (6.43) 

After taking the time derivative of (6.43) and then substituting (6.22) and 
the time derivative of (6.24) for E(g,g) and e(t), respectively, the following 
expression is obtained 

V = r^ ^kEF + ky (det(M)P~^) r + ^ky (det(M)P~^)^ f -f kpe 
By utilizing (6.17), (6.44) can be rewritten as follows 



(6.44) 



V = r'^ {{kE + ky) F + kyP-^W + ^ky (^ (det(M)p-i 



r H- kpe 



(6.45) 

After substituting (6.41) for F{t) and then simplifying the resulting ex- 
pression, the following expression can be obtained 



V = —kdr^r. 



(6.46) 



^The control strategy is called a gantry kinetic energy coupling control law because 
the control structure is derived from an additional gantry kinetic energy-like term in the 
Lyapunov function. 
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Based on the expressions given in (6.21), (6.24), (6.43), and (6.46), it is clear 
that r(t), r(t), e(t), g(t) G Coo- Hence, from (6.2) and (6.16) it is clear that 
x(t), i(t), y{t),y{t),r{t),9{t), ^{t) G £oo- The expressions given in (6.8), 
(6.11-6.15), (6.18), and (6.20) can be used to determine that det(M(g)), 
P~^{q), W{q, q) G Cqo- Based on the fact that (see Lemma B.24 of Appen- 
dix B) 

= -p-i p-i, 

dt \dt ) 

the time derivative of the product det(M)P~^(g) can be determined as 
follows 

^ (det(M)p-i) = ^^det(M)) p-^ - det(M)P-^ 

The time derivative of the determinant of M{q) given in (6.47) can be 
obtained from (6.8) as follows 

^ det(M) = rripLp'I [((m^ -h rric) rric + {rrip + rric) rrip) 

• (26 sin 9 cos 9^ + 2m^mp cos 00 sin 0 

• cos 0 ^2^ sin 9 cos 9 cos 0 — 20 sin^ 9 sin 0^ 

^20sin^cos0^ [m^rrip sin^ 0 cos^ 0 (6.48) 

-fmc [nir + rric -f rrip sin^ 0)] + sin^ 9 [rurmp 



((20 si 



sin 9 cos 9 cos' 



-{-mcrrip f 29 sin 9 cos 9 



' 0^ — ^20 sin^ 9 cos 0 sin 0^ ^ 

)i^ 



The time derivative of each element of P(g) given in (6.47) can be obtained 
from (6.11-6.13) as follows 



Pii = 'm: 



\L‘^I (2(f) sin 0 cos 4t9 sin 9 cos 9 cos^ 0 



—40 sin^ 9 sin 0 cos 0 ) -h 2mcrripL'^9 sin 9 cos 9 

^ (6.49) 

-\-2mc'mpL‘^ 19 sin 9 cos 9 — 2m^L^(j) sin^ 9 sin 0 cos 0 
-f-4mpL'^0 cos^ 0 sin^ 9 cos 9 
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Pi 2 = (cos^ (/) — sin^ 0) sin^ 0 

—Am^L'^0 sin (j) cos (p sin^ 9 cos 9 

(6.50) 

—rriyL^^Ip (cos^ p — sin^ 0) (sin^ 9 — cos^ 9) 

—ArUpL'^lb sin p cos p sin 9 cos 9 
P 22 = 4:rripL‘^9 sin 9 cos 9 sin^ p (m^L^ sin^ 9 + 1) 

+2mpL‘^psmpcosp [mpL^ sin^ 9 + 1 (sin^ 9 — cos^ 9)] (6.51) 

+2 {rrir + rric) rUpLi^b sin 9 cos 9 {rripL?' + /) . 

Based on the fact that q{t) ^ q{t) ^ P~^ {q) G £oo? if is clear that the expres- 
sions given in (6.47-6.51) can be utilized to prove that (det(M)P”^) G 
Coo- Given that e{t), r{t), P~^{q), W{q,q), ^ (det(M)P“^) G £ 00 , (6.41) 
can be used to show that F{t) G Coo- Finally, (6.3) and (6.19) can be used 
to show that Fx{t),Fy{t),u{t) G Coo- Since all of the closed-loop signals 
remain bounded and the time derivative of (6.43) is decreasing or constant 
as indicated by (6.46), Lemma B.23 of Appendix B can now be used to 
prove Theorem 6.3. □ 

6.2.4 Experimental Setup and Results 

The controllers given in (6.25), (6.33), and (6.41) were implemented on 
the InTeCo overhead crane testbed [29] shown in Figure 6.2. The testbed 
consists of two primary components: a mechanical system and a data ac- 
quisition and control system. For the mechanical system, the rail and the 
cart are driven by AC servo motors, and the payload is connected to a ca- 
ble attached to the underside of the cart through a shaft mounted encoder. 
The physical parameters of the overhead crane testbed were determined as 
follows 



rap — 0.73 [kg] ijic = 1.06 [kg] == 6.4 [kg] (6.52) 

I = 0.005 [kg • m^] L — 0.7 [m]. 

The data acquisition and control algorithms are implemented on a Pen- 
tium 266 MHz PC running under the RT-Linux operating system. The 
Matlab/Simulink environment and Real Time Linux Target [55] were used 
to implement the controllers. The Quanser MultiQ I/O board was used for 
the input/output operations. Specifically, four encoder channels of the Mul- 
tiQ I/O board were used to measure the position of the cart and the payload 
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angle, and two of the D/A channels were used to output the voltage to the 
DC motor. The output voltages were subject to two levels of amplifica- 
tion. The first level of amplification was achieved by an OP07 operational 
amplifier (i.e., signal conditioning), and the second level of amplification 
was enabled by a Techron linear power amplifier. The electrical dynamics 
associated with the testbed were neglected, and in an attempt to compen- 
sate for gantry friction effects, the following voltage-force relationship was 
implemented 

U == ks{{F FsSgn (x)) 

where kg is a scaling constant, V denotes the voltage output to the linear 
amplifier, F was designed in (6.25), (6.33), and (6.41), and Fg is the coef- 
ficient of static friction. The values that were used for kg and Fg are given 
below 

Fs-= 150. (6.53) 

To determine Fg, open-loop voltages were applied to the motor with in- 
creasing amplitude until the gantry began to move. The value for Fg that 
results in gantry movement was recorded as the static friction force. While 
numerous experimental methods exist to determine the static friction co- 
efficient, this simple approach yields suitable results to demonstrate and 
compare the effectiveness of the developed controllers. 




FIGURE 6.2. Experimental setup. 
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FIGURE 6.5. Results for the gantry kinetic energy coupling control law. 



Each controller was implemented at a sampling frequency of 1 [kHz] and 
the desired gantry position was selected as follows 

[ Xd UdY^ =[ 1-75 1.75 (6.54) 

For each of the experiments, the initial conditions were set to zero and 
the control gains were tuned until the best performance was achieved. The 
resulting control gains from each controller are given in Table 6.1 where 
diag{-} is used to denote a diagonal matrix.® 

The resulting gantry position error, payload angle, and the input force 
are shown in Figure 6.3 for the linear control law. Figure 6.4 for the 
coupling control law, and Figure 6.5 for the gantry kinetic energy coupling 
control law. A summary of the performance of the controllers given in 
(6.25), (6.33), and (6.41) is provided in Table 6.2. The settling time is 
defined as the interval between the starting time and the time when the 
angle 6{t) remained within ±0.5 [deg] of the equilibrium position and the 
response of x{t) and y{t) remained within 5% of the final values. 



°The stability analysis required that the gains fcp, kE, kv be defined as scalars; 
however, k^, kp, kE, kv were defined as matrices during the experiment. Although the- 
oretical justification is not provided, experimental experience indicates that this modi- 
fication usually improves the tracking performance in real-time implementations. 
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TABLE 6.1. Control gains 





Linear Control 
Law 


Coupling 
Control Law 


Gantry Kinetic Energy 
Coupling Control Law 




diag {0.5, 0.5} 


diag{l, 1} 


diag {0.6, 0.2} 


kp 


diag {3, 3} 


diag {5, 5} 


diag (3.2, 3} 


kE 


diagfl, 1} 


diag {0.01, 0.01} 


diag {0.8, 0.87} 


ky 


Not Applicable 


diag (0.29, 0.66} 


diag (0.2, 0.13} 



TABLE 6.2. Performance comparison 





Linear 

Control 

Law 


E^ Coupling 
Control Law 


Gantry Kinetic 
Energy Coupling 
Control Law 


X % Overshoot 


0% 


0.56% 


1.01% 


Y % Overshoot 


0% 


0.36% 


1.00% 


Settling Time 
(|6»| < 0.5 [deg]) 


> 40 [sec] 


19.9 [sec] 


9.3 [sec] 



The coupling control laws exhibit superior settling time when compared 
to the linear controller based on the results given in Table 6.2 and Figures 
6.3-6. 5. One reason for this superior performance is that the only pay- 
load/gantry coupling that exists for the linear controller is the natural cou- 
pling. When the gantry approaches the desired setpoint, friction damps the 
gantry to the extent that no overshoot can be observed. Hence, the gantry 
stops and the payload swings freely. In contrast, the payload/gantry cou- 
pling for the coupling control laws is enhanced, resulting in faster damping 
of the payload swing. 



6.3 VTOL Systems 

In this section, a nonlinear tracking controller is developed for the nonmini- 
mum-phase underactuated planar VTOL aircraft problem. A Lyapunov- 
based stability analysis is presented to demonstrate that the position and 
orientation tracking errors are globally exponentially forced to a neighbor- 
hood about zero which can be made arbitrarily small. A unified framework 
is developed that solves both the planar VTOL regulation and tracking 
problems. 
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6.3.1 System Model 

Dynamic Model 

The dynamic model for a planar VTOL aircraft can be written as follows 
[25] 

X = — sin {(f)) Ut + £ cos {(f)) Ura (6.55) 

y = cos (0) Ut-\- e sin (0) Um — 1 (6.56) 

(j) = v\ (6.57) 

Vl=Um- (6.58) 

For the dynamic model given in (6.55-6.58), x{t), y(t)^ (j){t) G M denote 
the Cartesian position and orientation respectively, of the center of mass 
(COM) of the aircraft, v\ (t) G M denotes the angular velocity of the air- 
craft, Ut (t), Um (t) G M represent the vertical force and the rotational torque 
applied to the aircraft, —1 represents the scaled gravitational acceleration, 
and £ G R is a nonminimum-phase parameter that represents the constant 
coupling between the rolling moment and the lateral acceleration of the 
aircraft (see Figure 6.6). To simplify the subsequent control development, 
the following transformation is defined 

xi = X — £sin {(f)) (6.59) 

yi = 2/ -he cos (0) (6.60) 

where xi (t), yi (t) G M represent the “shifted” Cartesian position. After 
taking the second time derivatives of (6.59) and (6.60), substituting (6.55) 
and (6.56) into the resulting expression, and then cancelling common terms, 
the shifted Cartesian system dynamics can be written as follows 

xi = — (ut — sin (0) (6.61) 

V\ = cos (0) - 1. (6.62) 



Reference Model 

Since the VTOL aircraft is subject to motion constraints (e.g., nonholo- 
nomic constraints), the desired trajectory must be designed under the same 
constraints to ensure that the trajectory is feasible. To this end, a VTOL 
reference model is defined based on the structure of the system dynamics 
given by (6.55-6.58) as follows 



Xr = - sin (0^) Urt -h £ cos (0^) Urm 



(6.63) 
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FIGURE 6.6. VTOL aircraft. 

jjr = COS {(f) J.) Urt + £ sin {(pr) Urm ~ 1 (6.64) 

= (6.65) 

Vrl — Urm- ( 6 . 66 ) 

In the reference model given in (6.63-6.66), Xr (t), Hr (0? (0 ^ ^ denote 

the reference Cartesian position and orientation, respectively, Vri {t) G R is 
a reference variable used to facilitate the analysis, and Urt (t), Urm (0 ^ ® 
denote the reference input signals. The reference signals Urt (t) and Urm (t) 
are assumed to be selected such that Urt (t), Urm (0? '^rt (0? '^rm {i) ^ 

Coo and Xr (t), Vr (t), (t>r (0 ^ (0) Vr (t), (j)^ (t), Xr (t), jjr (t) , (t) G Coo- 

To facilitate the subsequent error system development, a transformation 
similar to the one given in (6.59) and (6.60) is applied to the reference 
model as follows 

Xri = Xr — € sin (0^) (6.67) 

Vri = yr^ecos{(j)^) (6.68) 

where Xri (t), yri (t) ^ R represent the “shifted” reference Cartesian posi- 
tion. After taking the second time derivatives of (6.67) and (6.68), substi- 
tuting (6.63) and (6.64) into the resulting expression, and then cancelling 
common terms, the shifted reference Cartesian dynamics can be written as 
follows 

Xri = - (urt - sin (0^) 

j)rl = (urt - COS (0^) - 1. 



(6.69) 

(6.70) 
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6.3.2 Control Objective 

The control objective is to force the position and orientation of an aircraft 
performing the VTOL maneuver to track a desired trajectory. To quantify 
this objective, we define the position tracking error, denoted hy x{t)^y {t) G 
E, and the orientation tracking error, denoted by 0 (t) G E, as follows 

X = X-Xr y^y-Vr ^ = (6.71) 

After using (6.59), (6.60), (6.67), and (6.68), the position tracking error 
can be expressed in terms of the shifted position coordinates as follows 

5 = + e [sin (0) - sin {(j)^)] y = y^ - e [cos {(f)) - cos (0^)] (6.72) 

where xi (t), yi (t) G E denote shifted Cartesian tracking error signals that 
are explicitly defined as follows 



Xi = Xi - Xri yi =yi- yri- 



(6.73) 



As a direct consequence of the Mean Value Theorem (see Lemma A.l of 
Appendix A), it can be shown that 



lsin(0) -sm{4>^)\ < 



|cos(0) — cos (0^)1 < 



(6.74) 



hence, (6.72) and (6.74) can be used to prove that 



|5| ^ l^il + ^ 



0 



1^1 < l^il +£ 






(6.75) 



Prom (6.75), we can prove that if the shifted position tracking errors and 
the orientation tracking error are driven to zero then the actual aircraft 
position tracking errors will be forced to zero. Likewise, if the shifted po- 
sition tracking errors and the orientation tracking error are driven to a 
neighborhood about zero, then the actual aircraft position tracking errors 
will driven to a similar (but slightly larger) neighborhood. Based on these 
facts, the shifted position tracking errors are used in the subsequent con- 
trol design and stability analysis to reduce the complexity of the design. To 
further simplify the control design and stability analysis, a filtered tracking 
error signal, denoted by r{t) G E^, is also defined as follows 



r = 




Xi 

Vi 



(6.76) 



where /x G E represents a constant positive control gain. 
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6.3.3 Open-Loop Error System 

Since the VTOL aircraft system is subject to nonholonomic constraints, 
we are motivated to transform the error system so that it has a similar 
structure to Brockett’s Nonholonomic Integrator [9]. By performing this 
transformation greater insight can be gained into the control development. 
To this end, the following global invertible transformation is defined 

~ w 1 r 0 sin 0 -h 2 cos 0 — ^cos0 + 2sin(^ 0 1 [ rx ' 

zi = 0 0 1 (6.77) 

_ Z2 J L “ ^ ^ 0 J L ^ - 

T 

where w{t) eR and z{t) = [ zi{t) Z 2 {t) ] 6 are transformed track- 

ing error variables. After taking the time derivative of (6.77) and using 
(6.57), (6.58), (6.61), (6.62), (6.65), (6.66), and (6.69-6.71), the following 
open-loop tracking error system can be developed 



w — u^J^z -f- / 


(6.78) 


z = u 


(6.79) 


ill — '^rm 


(6.80) 



In (6.78), /(0,^,xi,y^) E R is defined as follows 



f = 2 {-Xri cos (0) - sin (0) - jjri sin ((/>) -f- ^^ 12 : 2 ) 



-f-2^ xi cos (0) + Vi sin (</>) 



is a skew-symmetric matrix defined as follows 



0 -1 

1 0 



T 

and u(t) = [ ui{t) U 2 (t) ] E R^ denotes a transformed control signal. 
Specifically, u(t) is related to the control signals ut (t) and v\ (t) given in 
(6.55-6.58) through the following globally invertible transformation 



u = r-i Ut Ut 

Vi 



(6.83) 



where T {rx,Vy,(p) 6 and 11(0, e R^ are defined as follows 



Tx COS (0) + Ty sin (0) 1 

. 1 0 



(6.84) 
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Vrl 



n — I ev\ + cos (0) — Xri sin (0) 4- yri cos {(j)) 
(y^ cos {(p) - xi sin ((/>) 



(6.85) 



6.3.4 Control Development 

Based on the subsequent stability analysis and the structure of the open- 
loop error system given in (6.78-6.80), the control signal Ud(t) G is 
designed as follows 

T 

Ud{t) —[ Udl U2 ] =Ua- k2Z. (6.86) 

For the controller given in (6.86), Ua{t) € is defined as 

'"-^']jzd + ^iZd (6.87) 

J 

where Zd{t) G R^ is generated by the following oscillator-like differential 
equation 




Zd = Y^Zd + ^ 4(0)^rf(0) = ^d(O) (6.88) 

and /ci,/c 2 G R denote positive constant control gains. The terms f)i(t), 
6d{t) G R given in (6.87) and (6.88) are defined as follows 

n, = (6,89) 

bd 6^ 

Sd = 7o exp(- 7 it) + ei (6.90) 

where 7 q, 7i, G R are positive constant control gains, and /(•) was 
defined in (6.81). The control input Um{t) of (6.80) is designed as follows 

'^m — ksV + zi - WZ2 + iidi + Urm (6.91) 

where /cs G R is a positive constant control gain. The error signal rj(t) G R 
introduced in (6.91) is defined as follows 

r] = udi-ui, (6.92) 

and the error signal zi(t) of (6.91) is an element of the vector z{t) = 
[ zi{t) Z 2 {t) ] G R^ that is defined as follows 



z = Zd - z. 



(6.93) 
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After substituting the time derivative of Ua{t) defined in (6.87) into the 
time derivative of (6.86), the expression for introduced in (6.91) can 

be determined as follows 



Udl 






^ u) I f \ 

+QiZdi + ) id2 - ^2^1 



(6.94) 



Si 



where the time derivatives of and f{t) are explicitly given by the 

following expressions 

_ Sd , (2kiw + f)w + wf + wf) 6d 

— C ^9 "T" ^ 9 . ^ c3 VD.yOj 



s<t si 
r - 

/= 2 



X2 

Sd 



^ (urt - e^r) cos 
- sin ^ilrt - M (urt - £<^r) 

(- Xi sin (0) + y-^ cos {4>)^ + VrlZ 2 + Urm^^ 



(6.96) 



Remark 6.3 Motivation for the structure of (6.88) is obtained by taking 
the time derivative of zj(t)zd{t) as follows 

= 

where (6.88) has been utilized. By exploiting the skew-symmetry of the 
expression given in (6.97) can be rewritten as follows 




^ i^d^d) = 2^zjzd. (6.98) 

As a result of the selection of the initial conditions given in (6.88), the fol- 
lowing solution to the differential expression given in (6,98) can be obtained 

ZdZd = \\zdf = sl- (6.99) 



The relationship given by (6.99) will be used during the subsequent error 
system development and stability analysis. 
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6.3.5 Closed-Loop Error System 

To facilitate the closed-loop error system development for w{t)y the control 
input Udi{t) is injected by adding and subtracting the product Udi{t)z 2 {t) 
to the right side of the open-loop dynamic expression for w{t) given in 
(6.78) to obtain the following expression 

w=[udi U 2 ] J^Z -t]Z 2-\- f (6.100) 

where (6.92) was used. After substituting (6.86) for [ Udi (t) U 2 (t) ] and 
then adding and subtracting the product u^{t)Jzd{t) to the resulting ex- 
pression, the dynamics for w(t) can be written as follows 

W = -u^Jzd + uIJz - t]Z2 + / (6.101) 

where (6.93) and the fact that ~ —J were utilized. By substituting 
(6.87) for only the first occurrence oiUa{t) in (6.101), utilizing the equality 
given by (6.99), exploiting the skew-symmetry of J defined in (6.82), and 
the fact that J^J = I 2 {I 2 denotes the standard 2x2 identity matrix), the 
final expression for the closed-loop error system for w{t) can be obtained 
as follows 

w — —k\w u^Jz — r]Z2. (6.102) 

To determine the closed-loop error system for 5(t), we take the time 
derivative of (6.93), substitute (6.88) for Zd{t), and substitute (6.79) for 
z{t) to obtain the following expression 

Z— ^ ^^ 1 ) J^d-[ Udl U2 ]^ + [ V 0 ]^ ( 6 . 103 ) 

where the control input Udi{t) was injected by adding and subtracting the 
vector [ Udl (0 ^ right side of (6.103) and then using (6.92). 

After substituting (6.86) for the vector [ Udi (t) U 2 (t) ] and then substi- 
tuting (6.87) for Ua(t) into the resulting expression, (6.103) can be rewritten 
as follows 



5= ~^Zd + w^liJzd - fliZd + k2Z+ \ T] 0 1^ . (6.104) 

Od 

After substituting (6.89) for only the second occurrence of fli{t) in (6.104), 
using the fact that JJ — —I 2 , and then cancelling common terms, (6.104) 
can be rewritten as follows 



-k2Z -h wJ 



kiw + / 

Od 



J Zd ^\Zd 



+ [ 77 0 



(6.105) 
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where (6.93) was utilized. Finally, since the bracketed term in (6.105) is 
equal to Ua{t) defined in (6.87), the final expression for the closed-loop 
error system for z{t) can be obtained as follows 

Z= —k2Z -f- wJUa + [ Tj 0 ]^ . (6.106) 

The following closed-loop error system for rj(t) is obtained by taking the 
time derivative of (6.92) and then substituting (6.80) and (6.91) into the 
resulting expression for iii (t) and Um(t), respectively 

V = ~ksT] + WZ2 - ^ 1 - (6.107) 



6.3.6 Stability Analysis 

The controller given in (6.86-6.91) forces the tracking errors for the VTOL 
aircraft to exponentially converge to an arbitrarily small neighborhood 
about the origin as stated in the following theorem. 

Theorem 6.4 The VTOL aircraft controller given in (6.86-6.91) ensures 
that the position/ orientation tracking error signals defined in (6.71) are 
GUUB in the sense that 



|i(i)l>|y(0l < /?3exp(-min{fci,fc2,/c3,7i,At}i) +£3 (6.108) 

< /3iexp(-min{/ci,fc2,fc3,7i}i) + (6.109) 

where 7 q, ^ were introduced in (6.90) and (6.76), respectively. The positive 
constants (3^, £ 36 ®. given in (6.108) are defined as follows 



/?3 =max;{|5i(0)| ,|yi(0)|} 



£3 = £i 



^ Pi {01 + 2^1 + 2 ) 

|/U-min{fci,fc2,fc3,7i}| 

(i+iil+e 



+ sPi 



( 6 . 110 ) 



where e was introduced in (6.55) and (6.56), Si were introduced in 
(6.90), and the positive constant /3i G R is defined as follows 



/^i = 11^(0)11+70- (6.111) 



In (6.111), the vector ^(t) G R^ is defined as follows 

[ W T] ] ^ . 



( 6 . 112 ) 
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Proof: To prove Theorem 6.4, we define a nonnegative function V{t) G R 
as follows 

V = \w^ + (6.113) 

After taking the time derivative of (6.113) and using the closed-loop error 
systems given in (6.102), (6.106), and (6.107), the following expression can 
be obtained 

V = w [-kiw u^Jz - rjZ2) T] {-ksT] + WZ2 - zi) (6.114) 



(^-k 2 Z H- wJUa -\- [ T] 0 . 

After utilizing the fact that = — J, cancelling common terms, and uti- 
lizing (6.113), the expression given in (6.114) can be rewritten as follows 

V < -2mm{ki,k2,ks}V. (6.115) 

By invoking Lemma A. 10 of Appendix A, the differential inequality given 
in (6.115) can be solved as follows 

V(t) < exp(— 2min {/ci, /c 2 , /ca} ^)U(O). (6.116) 

Based on (6.113), the expression given in (6.116) can be rewritten as 

||'J'(0ll < ||4^(0)||exp(-min{A:i,/c2,/c3}f), (6.117) 



where ^(t) was defined in (6.112). 

The expressions given in (6.112) and (6.117) can be used to prove that 
w{t)^ T]{t), z{t) G £oo- After utilizing (6.93), (6.99), and the fact that z(t), 
^d{p) ^ >Coo, we can conclude that z{t)^ Zd{t) G >Coo- Prom the fact that 
z(t), w{t) G Coo) the following inverse transformation of (6.77) 




COS0 


0 


( 0 COS (j) — 


2 sin (j) j 


w 


sincj) 


0 


( 0 sin (f) + 


2 cos (f) j 




0 


2 


\ 

0 


/ 


. ^2 



(6.118) 



can be used to prove that ra;(t), ry{t), (f)(t) G Coo- Based on the fact that 
^rr(t), Ty{t)^ (j){t) G Coo ^^d that the reference trajectory is selected so 
that yT’i(^), 0.p(t), (f), yri (^) ^ Coo^ the 

expressions given in (6.71), (6.73), and (6.76) and Lemma A.13 of Appendix 
A can be used to prove that xi (t), y-^ (t), xi (t), yi (t), xi{t), yi{t), xi{t), 
yi{t), (j){t) G Coo- Using the fact that ra;(t), ry{t), (j){t), x{t), y{t) G Coo, 
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(6.81) and (6.84) can be used to prove that /(•), T (•) G £oo- Based on these 
facts, (6.85-6.90) and (6.92) can be used to show that Udi{t)^ Ua{t), Zd{t), 
fli(i), ui{t), U 2 (t), n(-) e Coo- FVom (6.83), we can now conclude that 
ut(t), vi{t) G Coo- Based on the previous boundedness results, (6.94-6.96) 
can now be used to prove that Udiif) G Coo- Based on the facts that ry(/:), 
z{t), w(t), z{t), Udi{t), Urm{C) ^ Cooi cxprcssion given in (6.91) can be 
used to prove that Um {t) G Coo - 

To prove (6.109), we first show that z{t) of (6.77) is GUUB by applying 
the triangle inequality to (6.93) to obtain the following bound 



ll^ll < 1|5|1 + ll^dll < Piexp{-mm{ki,k2,k3,ji}t) +£i (6.119) 



where (6.90), (6.99), (6.112), and (6.117) have been utilized. Pi is defined 
in (6.111), and 7 q, 7i, Si were introduced in (6.90). Based on (6.118) and 
the bound given in (6.119), the result given in (6.109) can now be obtained. 
To prove (6.108), the transformation given in (6.118) and the bounds given 
in (6.117) and (6.119) can be used to obtain the following inequalities 





1 




1 




< 


-coscj) 


1^1 + 


-cos<f) 


4 > 



IZ 2 I + |sin</)| IZ 2 I 



< \w\ + l^il 12:2! + 12:21 

< P2exp{-mm{ki,k2,ks,'yi}t) + ^2 



( 6 . 120 ) 



where the positive constants P 2 , S 2 are defined as follows 

P2 — (2/^1 + + /^i) €2 = Cl 6i. (6.121) 



The same upper bound given in (6.120) can be developed for \ry{t)\ from 
(6.118). Based on the inequalities given in (6.120), an upper bound can 
now be developed for xi{t). Specifically, the expression given in (6.76) can 
be integrated as follows (see Lemma A. 19 of Appendix A) 

xi{t) = xi(0) exp(-/it) -h / exp(-^ {t - a))vx (cr) da. 

Jo 



( 6 . 122 ) 
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By using (6.120), the integral expression given in (6.122) can be upper 
bounded as follows 



< \xi{ 0 )\ exp{- fit) exp{- fit) exp(jLia) 62 da 

-i-exp(-fit) /q (/?2 exp((/i - min {/ci, /c 2 , A: 3 , 7 i}) ^)) 

< |xi( 0 )| exp(— /x^) -f — — — exp(— |x^) 

fi fi 

I /32exp(-min{A:i,fc2,fc3,7i}0 ~ 
\n-mm{ki,k2,k3,j^}\ 



< 



|ii(0)| exp(-/ii) + — + 



/^2exp(-miii{fci,fc2,fc3,7i}^) 

\/j.-mm{ki,k2,k3,j^}\ 

(6.123) 



Likewise, the following upper bound can be developed for \yi{t)\ 



li'i( 0 l < |j'i( 0 )|exp(-pt) + — + 



/?2 exp(- min {/ci, /c 2 , /C 3 , 7 i} t) 
|/x-min{/ci,A:2,A:3,7i}| 



(6.124) 



The result given in (6.108) can now be obtained by utilizing (6.75), (6.123), 
and (6.124). □ 



Remark 6.4 From the definition of 63 given in (6.110), it is clear that the 
tracking error variables, x (t), y (t), and 0 (f) can be made arbitrarily small 
by reducing the design parameters £,ei, and/or by increasing fi. Moreover, 
the rate of convergence of the errors to this arbitrarily small neighborhood 
around zero can be controlled through the design parameters ki, k 2 , /C 3 , 
and fi as is evident from (6.108) and (6.109). 

Remark 6.5 The occurrence of the term (fi — min {/ci, /c 2 , ^ 3 , 7 i}) in the 
denominator of (6.123) and (6.124) seems to indicate a potential singularity 
in the control law. However, in the event that fi = min {/ci, /c 2 , /C 3 , 7 ^}, 
the solution of the linear differential equations results in repeated roots. 
Specifically, if fi = min {/ci, /c 2 , /C 3 , 71 }, then (6.123) and (6.124) are now 
given by the following expressions 

l^i(0l < |5i(0)|exp(-/it) + (2/?i + 2/?iei -\- (3\) t exp{- fit) + — (6.125) 



1^1 (01 — |yi( 0 )| exp (— ^0 + ( 2/^2 + + P‘ 1 ) t exp(—fit) H — (6.126) 

T 

Remark 6.6 Since no restrictions were placed on the desired trajectory, it 
is straightforward that the tracking control development can also be applied 
to solve the regulation problem. 
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6.3.7 Simulation Results 

The controller given in (6.86-6.91) was simulated for a VTOL aircraft that 
is modeled by the expressions given in (6.55-6.58) where the coupling pa- 
rameter e was selected to be 0.1. The reference trajectory was generated 
according to (6.63-6.66) where u^t {t) and Urm (^) were selected as follows 

Urt = (l — exp (— O.U^)) cos (0.2^) 

Urm — (l — exp (— O.lt^)) sin (0.2t) . 

The actual and reference position and orientation and the respective first 
time derivatives were initialized to zero, and the auxiliary signal Zd {t) was 
initialized as 

2d(0)=[0.0 1.04]^. 

The control gains that resulted in the best performance were selected as 
follows 

ki = 10.0 300.0 h = l0.0 7o - 1.0 

= 0.01 = 0.1 Si — 0.04. 

The tracking control inputs are illustrated in Figures 6.7 and 6.8 and the 
resulting position/orientation tracking errors are shown in Figures 6.9-6.11. 




FIGURE 6.7. Control input ut (t). 
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6.3.8 Automotive Steering Extension 

Model Development 

The kinematic equations of motion of the COM for a front wheel driven 
and steered vehicle can be written as follows (see Figure 6.12) 

q = S{q)v (6.127) 

where q{t) E represents the time derivative of the Cartesian position 
and orientation of the vehicle COM defined by q{t) E as follows 

q{t)=[x{t) y{t) <f){t)Y, (6.128) 

the transformation matrix S{q) E is defined as follows 



5(g) = 



cos (0) 
sin (0) 
0 



— sin ((/)) 
cos (0) 

0 



0 ■ 
0 
1 



and the velocity vector v{t) E R^ is defined as 

V = [Vi V2 Vs]^ . 



(6.129) 



(6.130) 



For the vector given in (6.128), x{t), y{t), (j){t) E R denote the measur- 
able position/orientation of the COM of the vehicle with respect to a fixed 
inertial reference frame. For the vector given in (6.130), vi{t), and 

1 ) 3 (t) E R denote the vehicle’s measurable longitudinal, lateral, and yaw 
velocities, respectively. Under the assumptions that (i) the body-fixed co- 
ordinate axis coincides with the center of gravity (CG), (ii) the mass dis- 
tribution is homogeneous, (hi) the heave, pitch, and roll modes can be 
neglected, and (iv) the half tread of the vehicle is small (i.e., a bicycle 
model), the vehicle dynamic model can be expressed in the following form 
[26] 



mvi = 2{F:rf Fj:r) + rnv 2 Vs - Fd (vi) (6.131) 

mv2 = 2 {Fyf -h Fyr) - mv2Vs 

Ivs = 2{lfFyf—lrFyr). 

For the vehicle dynamic model given in (6.131), l/Jr ^ R denote the 
constant distances from the COM to front and rear axle, respectively, 
Foit) ^ R represents the known aerodynamic drag of the vehicle, Fxf{t), 
Fyf{t) E R denote the known front wheel forces acting perpendicular and 
parallel to the rear wheel axis, respectively, and Fxr{^)^ ^yr{t) ^ R denote 
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the known rear wheel forces acting perpendicular and along the rear wheel 
axis, respectively (see Figure 6.12). In the subsequent development, Fxf (t) 
and Fyf {t) are assumed to be the control inputs (see [49] for a discussion 
regarding the relationship between Fxf (t), Fyf (t) and the actual angular 
wheel velocity and the steering angle control inputs). 
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where Ut {t) and Um {t) G M are subsequently designed control inputs. By 
taking the time derivative of (6.127) and utilizing (6.129), (6.130), and 
(6.133), the vehicle dynamic model can be expressed in terms of the inertial 
reference frame as follows 



X = Ut cos (0) — e sin {(f)) Um (6.134) 

y = Ut sin {(f)) + e cos (0) Um (6.135) 

^ = V3 (6.136) 

V3 = Y (^”* “ 7^) (6.137) 



where ^ (t) , 5 G M are defined as follows 

g = 2^^J-^eFyr e = l. (6.138) 

m If 

To facilitate the development of the open-loop error system in a simi- 
lar form as the VTOL problem, the “shifted” Cartesian position for the 
automobile is defined as follows 



Xi = X — 



yi=^y- 



r 

m 



£ COS (0) 


(6.139) 


£ sin {(f)) . 


(6.140) 



After taking the second time derivatives of (6.139) and (6.140), substituting 
(6.134-6.137) into the resulting equations, and then cancelling common 
terms, the shifted Cartesian system dynamics can be written as follows 



Xi = 


+ 


—e(t) 
m J 


1 cos (0) - gsin{4>) 


(6.141) 


y\ = 


(ut + 


— £0 
m ) 


1 sin (0) + g cos (0) . 


(6.142) 



Reference Model Development 

Based on the structure of the system dynamics given by (6.134-6.137), 
the reference model for the automotive steering problem is defined in the 
following manner 



Xr = Urt COS {(f)^) — £ SlU {(f)^) Urm 


(6.143) 


yr = Urt sin {(p^) -f £ COS {(f)^) Urm 


(6.144) 


0r ~ ^3r 


(6.145) 
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V3r = 



TTlUqrjn 

I 



(6.146) 



where Xr (^), Vr (i), (j>r (^) ^ ^ denote the reference Cartesian position and 
orientation, respectively, v^r (t) ^ ^ denotes the reference yaw velocity, and 
Urt {t), Urm (0 ^ ^ denote the reference input signals that are assumed to 
be selected such that Urt (0? ^rm (0? (^)) ^rm (0 ^ ^oo and (t), (t), 

</)^(t), Xr(^), yr(^), (0? (^), (0 ^ ^oo- A transformation 

similar to (6.139) and (6.140) is applied to the reference system as follows 



Xrl = Xr 5 COS {(/) ) 

m 



(6.147) 



Vrl =Vr £Sin((/)^) 

m 



(6.148) 



where Xri (t), 2/ri (0 ^ ^ represented the shifted reference Cartesian posi- 
tion. After taking the second time derivatives of (6.147) and (6.148), uti- 
lizing (6.143) and (6.144), and then cancelling common terms, the shifted 
reference Cartesian dynamics can be rewritten as follows 



Xrl — 


^rt + 


I ;,2^ 

m'S 


|cos(</>J 


(6.149) 


i)rl = 


(urt + 


m ) 


|sin 


(6.150) 



Remark 6.7 The inputs to the reference generator, denoted by Urt (t) and 
analogous to the throttle and steering torque inputs, respec- 
tively, for a vehicle with a conventional steering system. These reference 
inputs can be selected appropriately to generate the position and orienta- 
tion reference signals. 



Open-Loop Error System 



To write the open-loop error system in a similar form as the VTOL problem, 
the transformation given in (6.77) is modified as follows 



w 




Zl 




. ^2 . 





cos (f) — 2 sin (j) 0 sin (/) -h 2 cos (j) 0 

0 0 -1 

cos (j) sin 0 0 





1 








0 . 



(6.151) 



where rx{t), ry{t), and 0 {t) were defined in (6.71) and (6.76). After taking 
the time derivative of (6.151) and using similar algebraic manipulation 
as described for the development of the VTOL open-loop error system, 
the open-loop error dynamics for the automotive steering problem can be 
expressed as follows 



w = u^J^z f -\-2g 



(6.152) 
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z = u 



(6.153) 

(6.154) 



^1 — ( / ) y d" '^rm 

For the open-loop error system of (6.152), J denotes the skew-symmetric 

matrix defined in (6.82), g{t) is defined in (6.138), and /(0, z, Xi, y^) G R 
is defined as follows 



/ = 2 [Xri sin ((/)) - Vri cos ((/)) -h vzrZ2] ~ 2/i sin (0) - cos ((/>) j 

(6.155) 

where /i was introduced in (6.76) and xi{t), yi{t) were defined in (6.73). The 
control signal u{t) = [ ui(t) U 2 {t) ] € R^ given in (6.152) and (6.153) is 

related to the control signals ut (t) and (t) through the following globally 
invertible transformation 



u = T'^ 



Ut 

Vs 



-n 



Ut 

Vs 



= T(u-hll) 



(6.156) 



where T {rx,Vy, (j)) G R^^^ and 11(0, x\^y^) G R^ are defined as follows 



-Tx sin (0) 4- Ty cos (0) 1 

-1 0 



(6.157) 



”^3r 



n = 



—€ — vl -h Xri COS (0) -h yri sin (0) 



~ g I Xi cos (0) -f y^ sin (0) 



(6.158) 



Based on the similarities in the structure of the open-loop tracking error 
dynamics given in (6.78-6.85) with the dynamics given in (6.152-6.158), 
the control structure given in (6.86-6.91) can be easily modified to achieve 
GUUB tracking and regulation for the automotive steering problem (see 
[49]). 



6.3.9 Surface Vessel Extension 

Model Formulation 

The kinematic model for an underactuated surface vessel can be written as 
follows 



q = S{q)v 



(6.159) 
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where q{t) is defined in (6.128) and x{t), y{t), e R now denote the 
measurable position/orientation of the COM of the surface vessel with re- 
spect to a fixed inertial reference frame, S{q) is defined in (6.129), and 
v(t) is defined in (6.130) where vi{t), 1 ^ 2 (0? ^3(^) ^ ^ denote the 

measurable surge, sway, and yaw velocities of the surface vessel, respec- 
tively (see Figure 6.13). Under the assumptions that (i) the body-fixed 
coordinate axis coincides with the center of gravity (CG), (ii) the mass dis- 
tribution is homogeneous, (iii^ the hydrodynamic damping terms of order 
higher than one are negligible, (iv^ changes in the inertia are negligible, 
and (v^ the heave, pitch, and roll modes can be neglected, the dynamic 
model for a neutrally buoyant surface vessel with two axes of symmetry 
can be expressed in the following form [23] 



Mi) -j- D{y)v = To (6.160) 



where v{t) denotes the time derivative of v{t) given in (6.159). 




FIGURE 6.13. Actuator diagram for an underactuated surface vessel. 
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In the dynamic model given in (6.160), M G represents the follow- 
ing constant diagonal positive-definite inertia matrix 

' m 0 O' 

M = 0 m 0 (6.161) 

_ 0 0 lo _ 

where m, /q € M represent the mass and inertia of the surface vessel, respec- 
tively, D{v) G represents the Centripetal-Coriolis and hydrodynamic 
damping effects as follows 

—Xyi 0 —mv2 

D{v)= 0 -Yy 2 mvi-Yys . (6.162) 

_ 0 —Ny2 —XyS 

In (6.162), Xyi, Yy2, Yys, Ny2, and Ny^ e M denote constant damping 

coefficients, and ro(t) G denotes the following force-torque control input 
vector 

To(t) = [ F 0 rf (6.163) 

where F{t) G M denotes a control force that is applied to produce a forward 
thrust, and r(t) G R denotes a torque that is applied about the center of 
gravity. As in the automotive steering example, the open-loop dynamics for 
the surface vessel can be partially feedback linearized as follows 

" Fi -h V2V3 

— {Yy2V2 -h Yy 

m 

. Ti 

by designing F{t) and r(i) as follows 

F — —XyiVi -h mFi (6.165) 

r == -Ny 2 V 2 - Ny^vs -f loTi (6.166) 

where (6.159-6.163) were utilized and Fi{t), ri{t) G R denote subsequently 
designed control inputs. By taking the time derivative of (6.159) and us- 
ing (6.129), (6.130), and (6.164), the surface vessel dynamic model can be 
expressed in terms of the inertial reference frame as follows 





Fi cos (p — (y cos <p — X sin 6) sin 6 — U 3 sin (b 

F\ sin (j) H — — (y cos 6 — x sin 6) cos 6 H — — cos 6 

m m 



(6.167) 
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Based on the structure of the surface vessel model given by (6.167), a 
reference model is defined as follows 



Xr 




Fir COS (j>r ' (Yv 2 (Vr COS (f>r Xr sin 4>r) + YvZ'CZr) 

Tfl 


yr 


— 


COS <i>r / f 

F\r sin (j)^ + {Vy2 {i/r COS (f)^ Xr siu (j)r) + YvSVSr) 


. . 




m 






. ^3r 



(6.168) 



where Xr (t), yr (t), (j)^ {t) € R denote the reference Cartesian position and 
orientation, respectively, and (^) G R denote the reference yaw 

velocity and thrust force, respectively, that are assumed to be selected such 
that F\rp{t^ G /^oo) ^ 3 r (^)5 ^ ^005 ^^d (t), (t), (f)^ (t), Xrp (^), y^p (t), 

(i), Xr (t) ,Vr {t),'4>r W ^ £oo- 

Open-Loop Error System 

To write the open-loop error system in a similar form as the VTOL aircraft 
and automobile steering problems, the transformation given in ( 6 . 77 ) is 
modified as follows 



W 




— COS (/) 4 - 2 sin (/) 


— (j6sin</) — 2cos(/) 


2^1 




' r-x 


Zl 


=: 


0 


0 


m 

1 




'ey 


. ^2 . 




COS0 


smcj) 


0 




. 0 . 



(6.169) 

where Tx(t), r^(t), and ^{t) were defined in (6.71) and (6.76). After taking 
the time derivative of (6.169) and using (6.129), (6.130), (6.159), (6.164), 
(6.167), and (6.168), the resulting expression for the open-loop tracking 
error dynamics can be determined as follows 

w = u^J^z -h / (6.170) 

z = u 

= -hr + ri. 



For the open-loop error system given in (6.170), J denotes the skew-symmetric 
matrix defined in (6.82), /( 0 , V 2 , x, y) G R is defined as follows 

/ == 2(vsrZ2 — FirSmzi+fi(sm(f)x—cos(l)y^^ (6.171) 

+ ~ Vy 2 {{i/r COS (j)^ — Xr sin 0^) COS Zi — V 2 ) 4- (cos Zi — 1) 

777 » 777 / 

T 

where y, was introduced in (6.76) and u(t) = [ Ui{t) U 2 {t) ] G R^ is 
related to the control signals Fi{t) and {t). Specifically, u(t) is related to 
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Fi (t) and vs (t) through the following globally invertible transformation 



u = T~^ 



Fi 

V3 



-n 



Fi 

V3 



^T{u + U) 



(6.172) 



where T{rx^ry^(j)) G and U{z,(l),vi) G R^ are defined as follows 



T = 



rx sin (j) — Vy cos 0 1 

1 0 



(6.173) 



V3r 



n 



Fir COS zi H Yy2 {Vr COS 4>^ - Xr sin (f)^) sin Z\ 

( • ^ a- ^-3 . 

— fi[Vi — Xr COS (p — Vr Sin 0) H U3r Sin Z\ 



(6.174) 



Based on the similarities in the structure of the open-loop tracking error 
dynamics given in (6.170-6.174) with the open- loop dynamics given for 
the VTOL and the automotive steering problems, the control structure 
given in (6.86-6.91) can be easily modified to achieve GUUB tracking and 
regulation for the underactuated surface vessel (see [6]). 



6.4 Satellite Systems 

In this section, a model-based controller is designed for the attitude track- 
ing and regulation problems for a rigid underactuated satellite. To address 
the under actuated nature of the satellite systems examined in this section, 
a dynamic oscillator-based design is utilized that is inspired by the develop- 
ment for the VTOL aircraft controller in the previous section. In contrast 
to the dynamic oscillator designed for the planar VTOL problem, the con- 
trol design in this section is baised on the unit quaternion parameterization. 
Provided the initial errors satisfy a sufficient condition, a kinematic control 
design is proven to exponentially force the tracking and regulation errors to 
an arbitrarily small neighborhood about the origin (i.e., UUB tracking and 
regulation). By employing integrator backstepping control techniques, an 
axisymmetric satellite extension is provided that also yields UUB tracking 
and regulation with an exponential rate of convergence. Simulation results 
are provided to illustrate the performance of the axisymmetric satellite 
tracking and regulation controllers under various initial conditions. 
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6.4.1 System Model 

Let T and X be orthogonal coordinate frames attached to the center of mass 
of a satellite and to an inertial reference frame, respectively. The kinematic 
model for a rigid satellite expressed in the unit quaternion parameterization 
is given as follows [28, 30] 

q = B{q)uj (6.175) 

where q{t) =[ qo{t) qy(t) G with qo{t) G R and where qv{t) € R^ 
represents the measurable unit quaternion that describes the orientation of 
T with respect to X, and cj{t) =[ uji{t) cJ 2 {t) 002 ,{t) G R^ denotes the 
relative angular velocity between X* and X. For the underactuated satellite, 
uji (t) is assumed to be a measurable exogenous bounded signal and a; 2 (t) 
and u;s{t) are assumed to be the control inputs. In the kinematic model 
given in (6.175), the Jacobian-type matrix B(q) G is defined as follows 




T 

-Tv 



Qoh + Qv 



(6.176) 



where the notation =[ Ci C 2 Ca]^ denotes the following skew- 

symmetric matrix 



0 “C3 C2 

- I C3 0 -Cl . (6.177) 

-C2 Cl 0 J 

The unit quaternion and the Jacobian-type matrix B{q) defined in (6.176) 
are subject to the following constraints 



q^q = 1 B'^B = h 



(6.178) 



where denotes the 3x3 identity matrix. Baaed on (6.178), the kinematic 
model given in (6.175) can be rewritten as follows 

u; = B'^{q)q. (6.179) 



6.4.2 Control Objective 

The satellite attitude tracking control objective is to force the orienta- 
tion of X to a desired orientation, denoted by Xd, where the orienta- 
tion of Td with respect to X is specified by a desired unit quaternion 
=[ Td{t) qydi^) with qod{i) ^ ^ and qvd(t) G R^. The time deriv- 
ative of qd{t) is related to the desired angular velocity of Xd, denoted by 
= [ <7'di(0 ^d2{t) i^dz{t) ] € R^, through the following expres- 

sion 



qd = B{qd)uJd- 



(6.180) 




312 



6. Under actuated Systems 



To quantify the mismatch between the actual and desired satellite attitudes, 
a rotation matrix R(e) G SO (3) that brings Td onto T is defined as follows 

R = RRJ = (cq - I 3 + 2eye^ - 2eoe ^ . (6.181) 

For the rotation matrix given in (6.181), R{q) G SO (3) denotes the rotation 
matrix that brings X onto T as follows 

^ = (Qo - ^ (lv)h + - 2qoq ^ , (6.182) 

RdiQd) ^ 50(3) denotes the rotation matrix that brings X onto X'd 
follows 

Rd = {qod - Qd Qd) h + 2gd9j - 2qodqd , (6.183) 

and the quaternion tracking error e{t) =[ eo{t) e'^(t) with eo(t) G R 
and ey{t) =[ eyi{t) ey 2 {t) ey 3 {t) G is defined as 

Cy 

Based on (6.178) and (6.184), it is clear that the unit quaternion tracking 
error satisfies the following constraint 

e^e = Cq + e^Cy = 1 (6.185) 

where 

0<|eo(OI<l 0 < ||e^t)|| < 1. (6.186) 

Based on the previous definitions, the satellite attitude tracking control 
objective can be stated as follows 

lim R(e) = Is. (6.187) 

t — >00 

The control objective can also be written in terms of the unit quaternion 
tracking error. Specifically, from (6.185), it can be proven that 

if lim ||et;(t)|| =0, then lim \eo{t)\ = 1; (6.188) 

t — >•00 >oo 

hence, (6.181) and (6.188) can be used to prove that 

if lim ||e-i;(^)|| == 0 then lim R{e) — Is. (6.189) 

t — >oo t — >oo 

Based on (6.188) and (6.189), the subsequent control design is motivated by 
the desire to force ey{t) to zero (or to some arbitrarily small neighborhood). 
The control objective is predicated on the assumption that q{t) and q{t) 
are measurable signals. 



9o9od + % Qvd 
QOdQv QoQvd "b qy Qvd 



(6.184) 
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Remark 6.8 The tracking control objective is formulated under the as- 
sumption that the desired trajectory input, denoted by qd{t)y is provided by 
a trajectory planning module that ensures that qod{^)j qvd{t)} ihe re- 
spective first two time derivatives are bounded for all time (note that qod{t) 
can be calculated via (6.180)). However, the trajectory planning module can 
also generate cod{t) from the following expression 

U)d, = B^{qd)qd (6.190) 



where (6.178) was utilized. 

6.4.3 Open-Loop Error System 

The open-loop tracking error dynamics can be developed by taking the time 
derivative of (6.184) and utilizing (6.179), (6.180), and (6.190) as follows 

eo = (6.191) 

ev = \{e^ +eah)Cj (6.192) 

where the angular velocity tracking error u{t) G is defined as follows 

uj = Lj — Ud (6.193) 

T 

where the auxiliary term uJd{t) = [ ^^di(^) ^d 2 (i) (^ds(t) ] G is 

defined as follows 

ujd = ^d- (6.194) 

To facilitate the subsequent control design and stability analysis, the open- 
loop error system given in (6.192) can be rewritten as follows 

W 3 ]^ + /) (6.195) 

Z = 1 (jzibi + Qe W 2 UJ 3 f - [ UJd 2 OJd3 ]^)) • (6.196) 

In the error system given in (6.195) and (6.196), the error variables x(t) G 
M, z{t) G are related to ey(t) of (6.184) as follows 

x = e^i z — [ e „2 e „3 ] , (6.197) 

J denotes the skew-symmetric matrix given in (6.82), /(eg, 62 , 63 , (Di) G M 
is defined as follows 



/ = eoo)i — e2U)d^ + e^Ud2 



(6.198) 
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where L0d2(t), ^dsit) were defined in (6.194), and (eo, ei) G is 

defined as 

1 . (6.199) 

_ ei eo 

6.4.4 Kinematic Control 

Based on the structure of the open- loop error system given in (6.195) and 
(6.196) and the subsequent stability analysis, the kinematic control input 
signals and cus (t) given in (6.175) are designed as follows 

[ o;2 (t) 0 J 3 (t) ]^ = -kpCoz -h [ LUd 2 (6.200) 

For the kinematic controller given in (6.200), /cp G R is a constant control 
gain, and Ua{t) G R^ is defined as follows 

Ua = UoJzd H- UiZd. (6.201) 

For the control signal given in (6.201), Zd(t) G R^ is defined by the following 
dynamic oscillator-like relationship 

id = + A Jzd (O)zd(O) = <5^(0) (6.202) 

Od 

and Ho (t), Ili(t), A (t), 6 d{t) G R are defined as follows 



kax + eo(Di 
1^0 — 2 
8 d 


(6.203) 


n 2^. , 

111 — c kpe^ 


(6.204) 


A = — {kpe^x + eono + Cui) 


(6.205) 


=7oexp(-7iO +£i 


(6.206) 



where /ca, 7 q, 7i, G R are positive constant design parameters. 

Remark 6.9 Note that based on the structure of the dynamic oscillator 
given in (6.202) with 8d{t) given in (6.206), the development given in (6.97) 
and (6.98) can be utilized to obtain the result given (6.99) (i.e., ||> 2 r(f(t)|| = 
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6.4.5 Closed-Loop Error System 

To facilitate the closed-loop error system development for x(t), we substi- 
tute (6.200) into (6.195) for uJ 2 {i) ^nd us (t), cancel common terms, then 
add and subtract the product zJ(t)Jua(t) to the resulting expression as 
follows 

X = - (co^i H- Jua - JUa) (6.207) 

where i(t) € is defined as 

z — Zd — z. (6.208) 

After substituting (6.201) for only the first occurrence of Ua{t) in (6.207) 
and then utilizing (6.203), the equality given by (6.99), the skew-symmetry 
of J defined in (6.82), and the fact that JJ — —I 2 (note that I 2 denotes 
the standard 2x2 identity matrix), the closed-loop error system for x{t) 
can be developed as follows 

X = —^kaX — ^z^ JUa. (6.209) 

To determine the closed-loop error system for z{t)^ we take the time deriv- 
ative of (6.208), substitute (6.202) for Zd{t)^ and then substitute (6.196) for 
z{t) to obtain the following expression 

5 = + kJZd - 1 - lOe [ "^2 - j ^g_210) 

Od 2 2 y ujz-ood^ _ 

After substituting (6.200) into (6.210) for 0^2 (0 ^^4 (t), and then can- 

celling common terms, the closed-loop error system for z(t) can be deter- 
mined as follows 

^Zd + KJZd + \kpslz - \ jz {ui + kpCox) - ( 6 . 211 ) 

Od z z z 

where (6.199) was utilized. After substituting (6.201) into (6.211) for Ua{t), 
utilizing (6.199) and (6.203-6.205), cancelling common terms and exploit- 
ing the skew-symmetry of J, the following expression for the closed-loop 
error dynamics for z{t) can be determined 

2 = ^ (-A:pep H- Jz {uji + kpO^x) -h xJua) . (6.212) 

6.4.6 Stability Analysis 

Based on the controller given in (6.200-6.206), the tracking errors for 
the underactuated satellite exponentially converge to an arbitrarily small 
neighborhood about the origin as stated in the following theorem. 
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Theorem 6.5 Given the closed-loop systems in (6.209) and (6.212), the 
kinematic controller of (6.200-6.206) ensures UUB tracking and regulation 
in the sense that 

\\ev (OH < Ai exp(-A20 + ^361 (6.213) 

provided that the initial errors satisfy the following sufficient condition 

IK (0)11 (6.214) 

where X\, A 2 , A 3 G R denote positive constants, and 6 eM. is some positive 
constant selected as follows 



8(7o + ^i) <^< 1 (6.215) 

where the control gains €i are given in (6.206). 

Proof: To prove Theorem 6.5, we define a nonnegative function V{t) eR 
as follows 

V = x^-h z^z. (6.216) 

After taking the time derivative of (6.216) and utilizing the closed-loop 
error systems given in (6.209) and (6.212), the following expression can be 
obtained 

V = X [-kaX - JUa) + Z^ [-k^e^Z -f Jz {uJi -f kpeox) + xJUa) . 

(6.217) 

After cancelling common terms and exploiting the skew-symmetry of J, 
(6.217) can be simplified as follows 

V = -kax^ -kpelz'^z (6.218) 

< -min{ka,kpel)V 

where (6.216) was utilized. The right-hand side of (6.218) can be further 
upper bounded as follows 

V < -I3V if |eo (f)| > \/l -(5^ > 0 (6.219) 

where /3 G R is a positive bounding constant, and <5 is a positive constant 
selected according to (6.215). The solution to the differential inequality 
given in (6.219) can be obtained as follows 

V (t) < exp(— /?^)U(0) if |eo (0| > Vl — 6^ > 0. (6.220) 

By utilizing (6.216), the inequality given in (6.220) can be rewritten as 

I1C(0I1< lie (0)11 exp(-^t) if |eo(f)|>Kl-^">0 (6.221) 
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where ({t) G is defined as 

C=[a: z'^ f . (6.222) 

After applying the triangle inequality to (6.208) and to the norm of ey{t), 
the following inequalities can be formulated 

Ikll < pll + W^dW < ll^ll +70 + 51 (6.223) 

ll^vll < kl + 2 (11^11 + 7o + ^i) (6.224) 

where (6.197) and (6.206) were utilized. By utilizing (6.185), the sufficient 
condition given in (6.219-6.221) can be rewritten as follows 

lle^ll = ^\-el< 6. (6.225) 

After using (6.224), the sufficient condition given in (6.225) can be ex- 
pressed in terms of the Lyapunov variables given in (6.216) as follows 

|a;(i)| + 2 ||2(i)|| < ^ - 2 (70 + £i) . (6.226) 



After utilizing (6.197), the sufficient condition given in (6.226) can be 
rewritten as follows 

(6.227) 

Based on (6.221) and (6.227), we can conclude that 

IIC(^)II<I1C(0)|| if ||C(f)ll<^^+^^. (6.228) 

The inequalities described by (6.228) imply that ||C(0ll upper 

bounded by ||C(0)|| provided ||C(0ll upper bounded by the second in- 
equality of (6.228). Since ||C (0)|| is a constant that can be independently 
restricted (i.e., it is a measure of the initial error between the desired and 
system orientations), the following upper bound for ||C (0)|| can be devel- 
oped so that both inequalities given in (6.228) are satisfied 

|K(0il<ilC(0)|| if ||C(0)||< ^ - ~^| + "^^ (6.229) 

By using (6.221), (6.222), and (6.229), the following inequalities can now 
be obtained 



Ikll, llzll < IK (0)11 exp 



a. 



if IK (0)11 < 



^ “ 2 (7o + £i) 



(6.230) 



3 
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From (6.206), (6.223), and (6.230), the following bound for z(t) can be 
developed 



Nl< lie (0)11 exp 



if ||C(0)||< ‘^~^^^»+ - l) 



(6.231) 



After utilizing (6.206), (6.208), (6.222), and (6.229), the following expres- 
sion can be obtained 



lie (0)11 <3 lie, (0)11 + 2 (7o + ei) (6.232) 

The inequality given in (6.232) can now be used to rewrite the sufficient 
condition given in (6.229-6.231) as in (6.214). Therefore, provided the con- 
dition given in (6.214) in satisfied, it is straightforward to prove that x{t)^ 
z(t), z(t), Zd(t) e Coo from (6.99), (6.230), and (6.231). Since x{t), z(t) e 
Coo Sind the reference trajectory is selected such that qodi't), Qvdi^) ^ ^oo? 
(6.184) and (6.197) can be used to prove that qy{t), qo{t) € £oo- Based on 
the facts that qod{t), qvd{t), 9o(t), qv{t) G £oo, (6.181) and (6.184) can be 
used to prove that e(t), ^(e) G Coo- Based on the assumption that ujd (t), 
(jJi (t) G Coo and the fact that ^(e) G £oo, (6.193) and (6.194) can be 
used to prove that Coi {t) G Coo- The preceding boundedness assertions and 
(6.198) can now be used to prove that f(t) G Coo- Based on (6.185) and 
(6.225), it can also be proven that 

|eo(i)l = -\/l-|K {t)f >Vl-6^ > 0 (6.233) 

provided the conditions given in (6.214) and (6.215) are satisfied. Given 
(6.233), we can now utilize (6.200-6.206) to prove that CJ2 (i), ^3 (t), Ua{t), 
Zd(t), rio(-), IIi(-) G Coo- Based on the fact that all of the signals are 
bounded under closed-loop operation, (6.230) and (6.231) can be used to 
prove the result given in (6.213), provided the conditions given in (6.214) 
and (6.215) are satisfied. □ 

Remark 6.10 The initial condition magnitude restriction given in (6.214) 
serves as a restriction on the desired unit quaternion, denoted by qd{t), as 
indicated by the definition of ey{t) given in (6.184)- That is, given the 
initial state of the system q(0), qd(0) must be selected such that \\ey (0)|| 
satisfies the sujficient condition given in (6.214)- 

6.4.7 Axisymmetric Satellite Extension 

The controller given in (6.200-6.206) was designed based on the assumption 
that the satellite velocities can be directly used as the control input (i.e., the 
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controller is based on the satellite kinematics). In practice, the satellite has 
dynamic effects that will result in a mismatch between the desired velocity 
control signals and the actual satellite velocity. To address the velocity 
mismatch, the satellite dynamics can be incorporated through integrator 
backstopping techniques. Specifically, in this extension q{t) and q (t) are 
assumed to be measurable and that the underactuated rigid satellite is 
modeled by (6.175) and by the following dynamic model [28] 

MlJ = Mlo + r (6.234) 

where the notation is given in (6.177). For the dynamic model given in 

(6.234) , M G denotes a diagonal matrix of the principal moments of 
inertia which is explicitly defined as follows 

M = diag{mi, m 2 , m 3 } (6.235) 

where diag{-} is used to denote the formation of diagonal matrix, mi, m 2 , 
m3 G R are positive constants, and the torque control input vector denoted 
by r(t) G R^ is explicitly defined as 

r = [0 T 2 Taf (6.236) 

where T 2 (t), T3 (t) G R are control torques applied in the direction of 
the last two principal inertia axes (i.e., the first principal inertia axis is 
underactuated). To facilitate the control design, the dynamics given in 

(6.234) are rewritten in the following advantageous form 





= C1U2OJS 


(6.237) 


LU2 


= C2iUiu;s + T2 


(6.238) 


U3 


= CsiUiLU2 + fs 


(6.239) 



where the control signals, denoted by T 2 (t), T 3 (t) G R, are defined as 
follows 



while Cl, C2, C3 G R are defined as 



The axisymmetric satellite dynamics can now be obtained by setting ci = 0 
in (6.237), and hence, from (6.237) it is clear that 



(Jui = 0 . 



(6.240) 
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To compensate for the mismatch between the actual velocity and the 
desired velocity, integrator backstopping techniques can be used to design 
the control torque input f{t) =[t 2 (t), e M? as follows 



r = ke 



^c2 


_ 


OJ 2 


)- 


C2^l^3 


+ 


' ^c2 ' 


^c3 




^3 


) 


_ C^(JiUJ2 




^c3 



+ fl^z — xj^ z 



(6.241) 

where /ce G M is a positive control gain, Uc 2 (0 (0 ^ ® represent the 

kinematic control inputs (i.e., the desired velocity) defined as follows 



T T 

[ UJc2 {t) ^c3 (0 ] ^ -kpCQZ H- [ UJd2 (^d3 ] + (6.242) 



where eo(t), odd 2 {t), cjdsit), z{t), kp, and Ua{t) were defined in (6.184), 
(6.194), (6.197), (6.200), and (6.201), respectively, and Uc2{i), ^c3 (0 
be obtained by differentiating (6.242). In contrast to the result given in 
[53], the axisymmetric extension given in this section does not require the 
restrictions that = 0 for the stabilization problem (i.e., uji can be any 
bounded constant value) or that Rudi (t) = ooi (0) for the tracking problem 
(i.e., we only need to ensure that Ru)di{t) and its first time derivative are 
bounded for all time, and that uoi (0) is bounded). 



6.4.8 Simulation Results 

In this section, numerical simulations for the under actuated axisymmetric 
satellite given in (6.175) and (6.237-6.239) are provided to illustrate the 
performance of the controller given in (6.197-6.206), (6.241), and (6.242). 
Specifically, tracking and regulation simulations are provided for different 
initial condition configurations. For each simulation, the inertia parameters 
for the axisymmetric satellite given in (6.235) were selected as follows 

mi = 20 [kgm^j m2 = 15 [kgm^j m3 = 15 [kgm^j. (6.243) 

Setpoint Controller 

To illustrate the regulation performance of the controller given in (6.197- 
6.206), (6.241), and (6.242), the initial attitude of the satellite was set to 
the following values 

go(0)=:\/ol 9^(0)= [0 -v^ -\/0l5 (6.244) 

such that (6.178) is satisfied, oji {t) was selected as 0 [rads“^j, and the 
oscillator signal Zd{t) was initialized as follows 

Zd( 0 ) = [ 2.001 0 ]^. 



(6.245) 
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After selecting the control gains in the following manner 

kp = 1.0 ka — 1.0 7q = 2.0 = 0.2 , 246') 

£i = 0.001 ki - 10.0 k2 = 10.0, ^ ‘ ^ 

the resulting satellite attitude regulation error and control torque inputs are 
depicted in Figure 6.14 and Figure 6.15, respectively. A second simulation 
was performed for the regulation problem using the same initial conditions 
and control gains, with the exception that LUi{t) = 0.005 [rads“^]. The 
resulting regulation error and control torque input are given in Figure 6.16 
and Figure 6.17, respectively. 




Time[sec] 



FIGURE 6.14. Orientation error: (a) evi{t), (b) ev 2 {t), and (c) ev 3 {t). 
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(a) 




FIGURE 6.17. Applied torque: (a) T 2 (t) and (b) rs (t). 

Tracking Controller 

For the satellite attitude tracking simulation, the desired trajectory was 
generated via (6.190) where <~0d (0 used as the reference input. Specif- 
ically, the reference trajectory input Od (t) was selected in the following 
manner 

= [ 0 sin(t) cos{t) (6.247) 

where the initial desired attitude of the satellite was selected as follows 

«od(0) = l q^{0) = [ 0 0 0 ]^ (6.248) 

such that (6.178) is satisfied. The initial satellite attitude was set to the 
following values 

go(0) = Vol q^{0)=[0 \Z045 ^/0l5]^, (6.249) 

LUi (t) was selected as 0 [rads~^], and Zd{t) was initialized as follows 

zd(0) = [ 2.07 0 ]^ (6.250) 

such that (6.202) is satisfied. After selecting the control gains as follows 



kp = 10.0 ka = 0.5 7 o = 2.0 7 ^ = 0.5 

£1 = 0.01 ki = 20.0 /C2 = 20.0, 



(6.251) 
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the resulting satellite attitude tracking error and control torque inputs are 
depicted in Figure 6.18 and Figure 6.19, respectively. As shown in Figure 
6.18, the satellite attitude tracking error is confined to a neighborhood 
around zero. From (6.213), it is clear that the tracking error neighborhood 
can be reduced by setting to a smaller value. 

To demonstrate that any bounded desired trajectory can be tracked 
within an arbitrarily small neighborhood, another simulation was con- 
ducted where the initial desired and actual angular velocities were selected 
as Udi (t) ^ ou I (0). Specifically, the desired satellite trajectory was selected 
as follows 

qod - 

Qvd{t) — [ \/0^sin (O.lt) \/0.45cos (O.lt) \/0.45cos (O.li) 

(6.252) 

such that (6.178) is satisfied. The initial attitude of the satellite was set to 
the following values 

go(0) = \/ol 9„(0) = [0 V05 (6.253) 

The initial value for cui (t) was arbitrarily chosen to be 0.01 [rad“^], and 
Zd{t) was initialized as follows 

^d(0)=[ 2.07 0 ]^. (6.254) 

After selecting the control gains as follows 

kp = 10.0 ka = 0.5 7 q = 2.0 7 ^ — 0.5 255^ 

£1 = 0.07 ki = 20.0 k2 = 20.0, ^ ^ 

the resulting satellite attitude tracking error and control torque inputs are 
depicted in Figure 6.20 and Figure 6.21. In comparison to Figure 6.19, 
larger torque values are shown in Figure 6.21 because Udi (t) ^ (0). 



6.5 Background and Further Reading 

Motivated by both practical applications and the fact that overhead cranes 
represent classical underactuated control problems, several researchers have 
developed various controllers for overhead crane systems. For example, Yu, 
Lewis and Huang [58] used a time-scale separation approach to control an 
overhead crane system. However, an approximate linearized model of the 
crane was utilized to facilitate the construction of the error systems. In 
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[56], Yoshida and Kawabe proposed a saturating control law based on a 
guaranteed cost control method for a linearized version of the crane sys- 
tem dynamics. Martindale et al. [37] used an approximate crane model 
to develop exact model knowledge and adaptive controllers, while Butler, 
Honderd, and Van Amerongen [11] exploited a modal decomposition tech- 
nique to develop an adaptive controller. In [13], Chung and Hauser designed 
a nonlinear controller for regulating the swinging energy of the payload. 

Several researchers have also examined the control problem for overhead 
crane systems with additional degrees of freedom. Specifically, Moustafa 
and Ebeid [42] derived the nonlinear dynamic model for an overhead crane 
and then utilized a standard linear feedback controller based on a linearized 
state space model. In [43], Noakes and Jansen developed a generalized 
input shaping approach for the linearized crane dynamics that exploited 
a notch filtering technique to control the motion of the bridge/trolley of 
an overhead crane system. More recently, Lee [33] developed a nonlinear 
model for overhead cranes based on a new 2-DOF swing angle definition. 
Based on this nonlinear model, Lee then developed an anti-swing control 
law for the decoupled linearized dynamics. In [47] , Sakawa and Sano derived 
a nonlinear model for a crane system, which was subsequently linearized 
to facilitate the development of a control scheme that first transferred the 
load to a position near the equilibrium point using an open-loop controller 
and then used a linear feedback controller to stabilize the payload about 
the equilibrium point. 

One of the limiting factors associated with the above overhead crane 
control designs is that the system nonlinearities are often excluded from 
the closed-loop error system design and stability analysis. To overcome this 
drawback, several researchers have investigated control approaches that ac- 
count for the nonlinear dynamics of overhead cranes and similar systems. 
For example in [52], Teel used saturation functions to develop an output 
feedback controller that achieves a robust semi-global stability result for the 
ball-and-beam control problem. In [10], Burg et al. transformed the non- 
linear crane dynamics into a structure that resembled the ball-and-beam 
problem and then adopted the research efibrts of [52] to achieve asymptotic 
positioning from a large set of initial conditions. More recently, Fantoni, 
Lozano, and Spong [21] and Lozano, Fantoni, and Block [35] proposed 
passivity-based controllers for the inverted pendulum and the pendubot 
(i.e., an inverted pendulum-like robot with an unactuated second link) 
based on the paradigm of driving the underactuated system to a homo- 
clinic orbit using an energy-based nonlinear controller and then switching 
to a linear controller to stabilize the system around its unstable equilib- 
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rium point. Using similar stability analysis techniques, Collado, Lozano, 
and Fantoni [14] proposed a PD controller for the overhead crane problem. 
In [31], Kiss, Levine, and Mullhaupt developed a PD controller for a ver- 
tical crane-winch system that only requires the measurement of the winch 
angle and its derivative rather than a cable angle measurement. Passivity- 
based interconnection and damping assignment control techniques are used 
in [24, 46] to stabilize underactuated mechanical systems. Specifically, the 
desired inertia matrix is parameterized such that energy shaping can be 
exploited to stabilize underactuated mechanical systems such as the ball- 
and-beam problem and the inverted pendulum. In [57], Yoshida developed 
a nonlinear energy-based controller to damp out the pendulum oscillations 
despite amplitude constraints on the trolly position. Recently, Fang et al. 
[20] developed several energy-based controllers for overhead crane systems 
in which additional nonlinear terms were injected into the controller to in- 
crease the coupling between the gantry position and the payload position 
to provide for improved transient response. 

Motivated by the tactical advantages that VTOL aircraft provide, several 
researchers have investigated control methods that can address the nonlin- 
ear nonminimum-phase underactuated dynamics. Specifically, Hauser, Sas- 
try, and Meyer [25] proposed an approximate input-output linearization 
approach. However, the controller was initially designed by assuming that 
the coupling between the thrust and the rolling moments can be neglected. 
Unfortunately, this assumption leads to magnitude restrictions on the cou- 
pling constant. Furthermore, the approach also requires that the roll of the 
VTOL aircraft be restricted to the interval (—90°, +90°). In [36], Martin, 
Devasia, and Paden proposed a tracking controller based on differential flat- 
ness. Specifically, the authors exploited the fact that the output at a point 
fixed with respect to the aircraft body (Huygens center of oscillation) can 
be used to transform the system into a flat input-state system. This result 
did not impose any restrictions on the coupling coefficients or on the roll 
of the VTOL aircraft. However, this controller does not produce a solution 
for tracking desired trajectories. In [22], Fliess et al. developed a differen- 
tial geometric approach for investigating system equivalence that is proven 
to reduce the dimension of complex systems. The approach was applied 
to several underactuated examples including an inverted pendulum and 
VTOL aircraft. In [34], Lin, Zhang, and Brandt designed a set-point con- 
troller using optimal control techniques. However, the control law required 
similar restrictions as those given in [25] (in addition, the control design 
methodology assumed that a part of the control input can be bounded as 
a state disturbance). In [38], McClamroch and Kolmanovsky proposed hy- 




6.5 Background and Further Reading 329 



brid switching strategies for two different setpoint control problems. In [3], 
dynamic inversion and robust control techniques were used to deal with 
the nonminimum-phase dynamics. However, this type of approach imposed 
restrictions on the desired trajectory. In [4], output tracking and maneu- 
ver regulating controllers were proposed to illustrate the advantages of a 
maneuver regulating controller over an output tracking approach. In [5], 
nontrivial extensions of [3] and [4] were presented for the conventional take- 
off and landing problem. In [44, 45], Oishi and Tomlin proposed a fusion 
of approximate linearization and switching techniques to develop tracking 
controllers in a “safe” envelope. However, some of the aforementioned re- 
strictions were not completely avoided. Sira-Ramirez recently proposed an 
approximate solution to the general reference trajectory tracking problem 
in [50]. 

Several solutions to the attitude control problem have been presented in 
the literature since the early 1970s (see [39]). In [54], the authors presented 
a general attitude control design framework that includes PD, model-based, 
and adaptive setpoint controllers. Adaptive tracking control schemes based 
on three-parameter kinematic representations were presented in [48, 51] to 
compensate for the unknown satellite inertia matrix. In [1] , an adaptive at- 
titude tracking controller based on the unit quaternion was proposed that 
identified the inertia matrix via periodic command signals. The work of 
[1] was later applied to the angular velocity tracking problem in [2]. An 
Hoo-suboptimal state feedback controller was developed for the quaternion 
representation in [18]. In [32], the authors designed an inverse optimal con- 
trol law for attitude regulation using the backstepping method for a three- 
parameter representation. Recently, the authors of [8] presented a variable 
structure tracking controller using quaternions in the presence of inertia 
uncertainties and external disturbances. In [16], Costic et al. presented an 
adaptive control solution to the quaternion-based attitude tracking control 
problem that eliminated angular velocity measurements and compensated 
for parametric uncertainty. 

Recently, there has been some interest in designing controllers for the 
underactuated rigid satellite tracking/regulation problem (see the Notes 
Section of Chapter 5 for a review of research targeting the fully actuated 
satellite problem). In [17], Crouch provided necessary and sufficient con- 
ditions for controllability of a rigid body in the case of one, two, or three 
independent actuators. In [12], Byrnes and Isidori demonstrated that a 
rigid satellite with only two controls cannot be asymptotically stabilized 
via continuous-state feedback since it does not satisfy Brockett’s neces- 
sary condition [9] for smooth feedback stabilizability. In [40], Morin et al. 
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developed a smooth time-varying stabilizing controller by using averaging 
theory. A continuous time-varying/time-periodic switching controller was 
proposed by Cor on and Kerai in [15]. Using averaging theory and Lyapunov 
control design techniques, Morin and Samson [41] developed a continuous 
time- varying controller that locally exponentially stabilized the attitude of 
a rigid spacecraft. In [53], Tsiotras and Luo proposed a saturated, track- 
ing/stabilizing controller for the kinematic control of an underactuated 
axisymmetric spacecraft. However, the spin rate on the unactuated axis 
is required to be zero. Recently in [7], Behai et al. developed a track- 
ing/stabilizing quaternion-based controller for the kinematic control of an 
underactuated axisymmetric satellite that eliminated the requirement for 
a zero spin rate of the unactuated axis as required in [53]. 
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Appendix A 

Mathematical Background 



In this appendix, several fundamental mathematical tools are presented in 
the form of definitions and lemmas that supplement the control develop- 
ment and closed-loop stability analyses presented in the previous chapters. 
The proofs of most of the following lemmas are omitted, but can be found 
in the cited references. 

Definition A.l [ 9 ] 

Consider a function f(t) : ^ R. Let the 2-norm (denoted by II-H2) of 

a scalar function f{t) be defined as 



\\mh=^ sj Pir) dr. (A.1) 

If||/Wll2 < 00, then we say that the function f{t) belongs to the subspace 
£2 of the space of all possible functions (i.e., f{t) G £2)- Let the oo-norm 
(denoted by IHI^) of f(t) be defined as 

ll/Wlloo =sup|/(i)|. (A.2) 

If||/Wlloc < 00, then we say that the function f(t) belongs to the subspace 
Coo of the space of all possible functions (i.e., f{t) G £00 )• 
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Definition A. 2 [9] 

The induced 2-norm of matrix A{t) is defined as follows 

P(i)l|,2 = (A.3) 

Lemma A.l [4] 

Given a function / : ^ IR that is continuously differentiable on an 

open set S C and given points (xio, ...,Xno) and (xi, ...,Xn) in S that 
are joined by a straight line that lies entirely in then there exists a 
point (^ 1 , the line between the endpoints, such that 

f{xi,...,Xn) = f{xio,---,Xno) ~ ^jo) ■ (A.4) 

j = l ^ 

This lemma is often referred to as the Mean Value Theorem. 

Lemma A. 2 [6] 

Given a function / : x R"^^ R^ that is continuously differentiable at 

every point (x^y) on an open set S C R^xR^, if there is a point (xo,yo) 
on S where 

f{xo,yo) = 0 (A.5) 

and 

Of 

-^{xo,yo) ^0, (A.6) 

then there are neighborhoods U C and V C R^ of xq and yo, respec- 
tively, such that for all y G V the expression in (A.5) has a unique solution 
X ^ U. This unique solution can be written as x = g{y) where g is con- 
tinuously differentiable at ?/ — t/q- This lemma is often referred to as the 
Implicit Function Theorem. 

Lemma A.3 [3] 

Given a,6, c G R^, any of the following cyclic permutations leaves the 
scalar triple product invariant 

a - (b X c) = b ' {c X a) ~ c • (a X b) (A. 7) 

and the following interchange of the inner and vector product 

a ' {b X c) = (a X b) • c (A. 8) 

leaves the scalar triple product invariant where the notation a • b represents 
the dot product of a and b and the notation a x b represents the cross 
product of a and b. 
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Lemma A. 4 [3] 

Given a, 6, c G the vector triple products satisfy the following expres- 
sions 

a X {b X c) = {a ' c)h — [a ■ h) c (A- 9 ) 

(a X b) X c (a ■ c) b — {b • c) a (A. 10) 

where the notation a • b represents the dot product of a and b and the 
notation a x b represents the cross product of a and b. 

Lemma A. 5 [3] 

Given a, 6 G R^, the vector product satisfies the following skew-symmetric 
property 

a X b — —b X a (A. 11) 

where the notation a x b represents the cross product of a and b. 



Lemma A. 6 [3] 



Given a — a\ U2 03 ] G R^ and G R^^^ which is defined as 
follows 

0 —03 tt2 

as 0 — ai (A. 12) 

[ -U2 ai 0 



then the product satisfies the following property 

[ 0 0 0 ]^. 

Lemma A. 7 [8] (Theorems 9-11) 



(A.13) 



Given the symmetric matrix A G and the diagonal matrix D G 

Rnxn^ then A is orthogonally similar to D and the diagonal elements of D 
are necessarily the eigenvalues of A. 



Lemma A. 8 [9] 

If w{t) : R^ R is persistently exciting and w{t), w(t) G £00 , then the 
stable minimum-phase rational transfer function H (w) is also persistently 
exciting. 
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Lemma A. 9 [10] 

If f{t) = is bounded for t € [0, oo), then f{t) is uniformly contin- 

uous for t 6 [ 0 , oo). 

Lemma A. 10 [ 1 ] 

Let V (t) be a nonnegative scalar function of time on [0, oo) which satisfies 
the differential inequality 

V{t) < -jV{t) (A.14) 

where 7 is a positive constant. Given (A.14), then 

V{t) < y(0)exp(— 7 t) Vt G [0,oo) (A.15) 

where exp (•) denotes the base of the natural logarithm. 

Lemma A. 11 



Given a nonnegative function denoted by F (t) G R as follows 



V = 

2 



with the following time derivative 



V = -kix^^ 



(A.16) 



(A.17) 



then x(t) G R is square integrable (i.e., x{t) G £ 2 )* 

Proof: To prove Lemma A.ll, we integrate both sides of (A.17) as follows 



— / V{t)dt = ki / x‘^{t)dt. (A.18) 

Jo Jo 

After evaluating the left side of (A.18), we can conclude that 

POO 

ki / x'^{t)dt = Vi0)-V(oo)<V (0) < 00 (A. 19) 

Jo 

where we used the fact that F(0) > V ( 00 ) > 0 (see (A.16) and (A.17)). 
Since the inequality given in (A. 19) can be rewritten as follows 



I x^t)dt 



(A.20) 



we can use Definition A.l to conclude that x{t) e £ 2 - D 
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Lemma A. 12 [ 5 ] 

Let A 6 be a real symmetric positive-definite matrix; therefore, 

all of the eigenvalues of A are real and positive. Let Amin{^} ^-nd Amax{^} 
denote the minimum and maximum eigenvalues of A, respectively, then for 
Vx G R^ 

Amin{^} IkiP < x'^Ax < Amax{>!} ||x||^ (A.21) 

where H-H denotes the standard Euclidean norm. This lemma is often re- 
ferred to as the Rayleigh-Ritz Theorem. 

Lemma A. 13 [ 1 ] 

Given a scalar function r{t) and the following differential equation 

r = e + ae (A.22) 

where e{t) G R represents the time derivative e{t) G R and a G R is a 
positive constant, if r{t) G £00 then e{t) and e{t) G £00 • 

Lemma A. 14 [ 1 ] 

Given the differential equation in (A.22), if r{t) is exponentially stable 
in the sense that 

\r{t)\ < Poexp{-/3it) (A.23) 

where /?q and £ R are positive constants, then e{t) and e{t) are expo- 
nentially stable in the sense that 

|e(t)| < |e(0)| exp(-at) -| (exp(-/?it) - exp(-a^)) (A.24) 

Oi — Pi 

and 

|e(^)i < a |e(0)| exp(-ai) H — — (exp(-/3^t) - exp(— o:i)XA.25) 

OL Pjl 

+/?oexp(-/3ii) 
where a was defined in (A.22). 

Lemma A. 15 [ 1 ] 

Given the differential equation in (A.22), if r{t) G £00, f'(t) G £ 2 , and 
r{t) converges asymptotically in the sense that 

lim r(t) = 0, 

t—^00 

then e{t) and e{t) converge asymptotically in the sense that 



(A.26) 
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Lemma A. 16 [9] 

Consider a function f{t) : R+ — > M. If f{t) G £005 /(O ^ ^ 00 ? 
f{t) G £ 2 , then 

lim f{t) = 0 . (A.28) 

t — >00 

This lemma is often referred to as Barbalat’s Lemma. 

Lemma A. 17 [1, 7] 

If a scalar function Nd{x,y) is given by 

Nd = Q{x)xy — kn^‘^{x)x‘^ (A.29) 

where x,y G K, f^(x) G M is a function dependent only on x, and is a 

positive constant, then Nd{x^y) can be upper bounded as follows 

Nd<^- (A.30) 

The bounding of Nd{x^y) in the above manner is often referred to as non- 
linear damping [7] since a nonlinear control function (e.g., knQ?{x)x‘^) can 
be used to “damp-out” an unmeasurable quantity (e.g., y) multiplied by a 
known measurable nonlinear function, (e.g., Q>{x)). 

Lemma A. 18 [ 1 ] 

Let V (t) be a nonnegative scalar function of time on [0, 00 ) which satisfies 
the differential inequality 

V < -jV + e (A.31) 

where 7 and e are positive constants. Given (A.31), then 

V{t) < y(0)exp(— 7 ^) + - (1 — exp(— 7 ^)) \/t G [0,oo). (A.32) 

7 

Lemma A. 19 [1] 

If the differential equation in (A. 22) can be bounded as follows 

lr(i)| < Bexp{—kt) (A.33) 

where k, A, and B G R and A -f J5 > 0, then e{t) given in (A. 22) can be 
bounded as follows 

|e(t)| < |e(0)| exp(-a^) + — (1 - exp(-a^)) (A.34) 

a 

where 

a = y/A and b = Vb. (A.35) 
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Lemma A. 20 [ 6 ] 

If a function f(t) : R4. ^ M is uniformly continuous and if the integral 

lim f |/(r)|dr (A.36) 

exists and is finite, then 

lim |/(i)| = 0. (A.37) 

t—t’OO 

This lemma is often referred to as the integral form of Barbalat’s Lemma. 

Lemma A. 21 [ 2 ] 

If a given differentiable function f{t) : R4. R has a finite limit as 
t 00 and if fit) has a time derivative, defined as /(t), that can be written 
as the sum of two functions, denoted by gi{t) and g 2 {t)^ as follows 

f{t) ^91+92 (A.38) 

where g\ (t) is a uniformly continuous function and 

lim g 2 {t) = 0 (A.39) 

t— >00 

then 

lim f{t) = 0 lim gi(t) = 0. (A.40) 

t—*oo t—*oo 

This lemma is often referred to as the Extended Barbalat’s Lemma. 

Lemma A. 22 [ 6 ] 

Let the origin of the following autonomous system 

X = f{x) (A.41) 

be an equilibrium point x{t) = 0 where /(•) : D is a. map from the 

domain D C R’^ into R”^. Consider a continuously differentiable positive 
definite function V{') \ D R’^ containing the origin x(t) = 0 where 

V{x) <0 in D. (A.42) 

Let r be defined as the set of all points where € D\V{x) — o| and 
suppose that no solution can stay identically in F other than the trivial 
solution x{t) = 0. Then the origin is globally asymptotically stable. This 
Lemma is a corollary to LaSalle’s Invariance Theorem. 
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Appendix B 

Supplementary Lemmas and 
Definitions 



In this appendix, supplementary lemmas and definitions are provided to 
support the mathematical development in the previous chapters. Proofs 
are provided for most of the lemmas. 



B.l Chapter 2 Lemmas 

B.l.l Convolution Operations for Torque Filtering 

Lemma B.l The filtered control input signal Uf{t) defined in (2.32) can 
he expressed as the the linear parameterization given in (2.3 J^). 

Proof: To rewrite (2.32) in terms of the linear parameterization given 
in (2.34), the expression given in (2.10) is written in the following form [2] 

u—'h-Vg (^-1) 

where 

h=^(M{q)q) (B.2) 



and 



g = -M{q)q + Vm{q,q) 



(B.3) 
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After substituting (B.l) into (2.32), the following expression can be ob- 
tained 



Uf = f{t) * Ya {q, q)4> + YB {q, q) cP + f (t) * Yc {q, q) (B.4) 

where the standard convolution properties 

f*^k + g^=f*h + f*g (B.5) 

and 

f^h = f^h-\-f{0)h-fh{0) (B.6) 

have been used. The linear regression matrices Ya (^, q) 0, Yb 4) 0, and 

{qiQ)(t^ in (^-4) are defined as follows 

YAiq,q)cP = M{q{t))q{t) (B.7) 

yB{q,q)4> = f {0) M (q {t)) q (t) - f (t) M {q {0)) q (0) 
Yc{qA)<t> = -M{q{t))q{t) + Vm{qA)- 

By utilizing standard Laplace Transform techniques, the expression in (B.4) 
can be rewritten as follows 

Uf^{?A {q, q) + Yb {q, q) + Yc {q, 4)) <P (B.8) 

where the regression matrices Ya (g, q) and Yc ( 9 , q) are generated by the 
following differential expressions 

(qA) + jYA{qA) = -i^YA{qA) (B.9) 

Yc {q,q) YiYc{qA) = ^Yc{qA) 

where (2.33) and (2.36) were utilized. Hence, based on (B.8) and (B.9), it 
is straightforward to conclude that (2.32) can be rewritten as the linear 
parameterization given in (2.34). □ 

B.1,2 Control Signal Bound 

Lemma B.2 The term xiq^q^'^) defined in (2.48) can be upper hounded 
by the following inequality 



llxll<CiPII 



(B.IO) 
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where Cj E R is a known positive bounding constant and z (t) G is 
defined as follows 

z{t)=^[x{t) y{t) e{t) r'^ {t) f . (B.ll) 

Proof: To prove that (B.IO) is a valid bound for % (•) = [ Xi X 2 Xs ] ^ 
(2.11), (2.12), (2.22), (2.38), and (2.39) are used to compute the difference 
given in (2.48) as follows 

Xi = —aimx — mL sin {6 (3) 6 a + cos {9 + (3) 69d 

— cos (3 (dd sin 9 cos 9^ + sin (3 (^-9d cos 9 0^^ sin 9^ 

(B.12) 

X 2 = -OL 2 'my - mL - cos {9 + /?) 0^ + sin {9 -f p) 99 d 

(B-13) 

+ cos P (dd cos 9 — 9^^ sin 9^ — sin P (^d sin 9 0^^ cos 9^ 

Xs = mL (oix sin {9 + P) - a 2 y cos {9 -f /?)) . (B.14) 

After utilizing (2.18) and (2.19), exploiting several trigonometric identities, 
and cancelling common terms, the expressions given in (B.12-B.14) can be 
rewritten as follows 

Xi = aim (ri + aix) + mL cos {9 + P) 9de (B.15) 

X2 = o^ 2 m {v 2 -f a 2 y) + mL sin {9 + P) 9de (B.16) 

X3 == mL (-ai (ri + aix) sin {9 P) a 2 (^2 + a 2 y) cos (9 + P)) . (B.17) 

Based on the expressions given in (B.15-B.17) and the definition of z{t) 

given in (B.ll), the bound given in (B.IO) can now be directly obtained. □ 

B.1.3 Control Signal Bound 

Lemma B.3 The auxiliary signal Q{q,qp) defined in (2.45) can be upper 
bounded by the following inequality 

||Q|| <7CilV’l| (B.18) 

where 7 was defined in (2.33), Q G M is a known positive bounding constant, 
and 'ip(t) G is defined as follows 



(B.19) 
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Proof: To prove that (B.18) is a valid bound for Q {q, q, t), the expression 
given in (2.47) is first rewritten as 

u = Y(j) = x-^ yd(f>2 + 'ipi (B.20) 

where q,t) G K is an auxiliary function defined as follows 

= -Mr - VmV (B.21) 

and was defined in (2.130). After substituting the closed-loop dy- 

namics for r (t) given by (2.52) into (B.21), and cancelling common terms, 
the following expression is obtained 

'01 = -Yd ^2 - X + KsV - [ kpix kp 2 V 0 + knClr. (B.22) 

Since 9d(t)^ 9d{t), and the trigonometric terms in (2.38) always remain 
bounded, an upper bound for Yd (g, t) ^2 can be formulated as follows 

|^ci02|| <C,||02|| (B.23) 

where G R is a positive scalar constant. By utilizing (2.49), (2.50), and 
the bound given in (B.23), an upper bound for (B.22) can be formulated 
as follows 

11^1 II < Cy ||^ 2 || + Cl Ikll + Ks ||r|| + fcpi |x| + kp 2 \y\ + Ikll . (B.24) 

Given the definitions for 0 (t) and z{t) in (2.56) and (2.50), respectively, 
the upper bound given in (B.24) can be rewritten in the following compact 
form 

IIV'ill <C2ll^ll (B.25) 

where C 2 ^ is a positive bounding constant. After rewriting (B.20) as 
follows 

T0-y^02 = X + 0i (B.26) 

and then utilizing (2.49) and (B.25), the following inequality can be for- 
mulated 

11^0 - YM < llxll + 11^1 II < Cl Ikll + C 2 IIV'II < C Ill'll (B.27) 

where C ^ R is a positive bounding constant, and 0 {t) and z (t) were 
defined in (2.56) and (2.50), respectively. 

Based on (2.32), (2.37), and (2.45), ft (^, q, t) can be expressed as follows 

n = f^{Ycf>-Yd(l>2) (B.28) 
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where / (t) was defined in (2.33). An upper bound for (B.28) can now be 
formulated as follows 

m\<j\\Y<p-Yd4>2\\ (B.29) 

where the standard inequality property of convolution in [4] and the upper 
bound 11/ (t)\\ < 7 have been applied (see (2.33)). After substituting (B.27) 
into (B.29), the inequality given by (B.18) can be obtained. □ 

B.1.4 Control Signal Bound 

Before developing lower and upper bounds for given in (2.43), the 

following preliminary lemma is presented. 

Lemma B.4 Given the definition of P~^ (t) in (2.43), it can be shown 
that 

\\P\\i2P~^>h (B.30) 

where Is is the 3x3 identity matrix and the matrix inequality A > B for 
A,Be is a shorthand notation to denote f,^A^ > B^, G MP. 

Proof: Given the definition of P~^{t) in (2.43) and the fact that P (0) is 
selected to be positive-definite and symmetric, P~^ (t) is positive-definite 
and symmetric for all time. Hence, it follows that P (t) is also positive- 
definite and symmetric for all time. Since P{t) is a positive-definite and 
symmetric gain matrix, the Rayleigh-Ritz Theorem (see Lemma A. 12 of 
Appendix A) can be used to prove that 

^^Ajnax X > x^Px (B.31) 

where A^ax {•} denotes the maximum eigenvalue of {•}. Based on Lemma 
A.7 and Definition A.2 of Appendix A, the following property can be proven 

Amax {P} = y^Amax {P^P} = ||P||i2 * (B.32) 

By utilizing (B.32), the expression given in (B.31) can be rewritten as 
follows 

x^\\P\\.^x>x^Px. (B.33) 

To facilitate the remainder of the proof, y G R is defined as follows 

y = \/Px. (B.34) 

After rewriting the right-hand side of (B.33) as follows 



x^ Px = x"^ \fP\fPx 



(B.35) 
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and then utilizing the expression given in (B.34), the following expression 
can be obtained 

(v^) y/P'/P (ypj y == y^hy- (B.36) 

In a similar manner, (B.34) can be used to rewrite the left-hand side of 
(B.33) as follows 

||P ||,2 a: = ||P ||,2 (^/p) (v/p) - 2 /^ ||P ||,2 P~^y- (B.37) 

The expressions given in (B.33-B.37) can now be used to prove the result 
given in (B.30). □ 

Lemma B.5 The gain forgetting factor X (t) and the gain matrix P~^ (t) 
defined in (2.58) and (2.43), respectively, can be upper and lower bounded 
by the following inequalities 

0 < < A (() (B.38) 

< P-^ (t) < k-2h (B.39) 

where k is defined in (2.63). 

Proof: To prove Lemma B.5, the lower bound for P~^ (t) is obtained 
and then the upper and lower bounds on the gain adjusted forgetting factor 
A (t) are developed, which are used to derive the upper bound for P~^ (t). 

Lower bound for P~^ (t): 

By substituting (2.58) into (2.42), the following expression can be ob- 
tained 

p-i = -AiP-i+ ^^\\P\\.^P-^ +YlfY,f . (B.40) 

The solution to the differential equation given in (B.40) can be determined 
as follows 

P~^ (t) = (O)exp(-Ai^) + [ exp{-Xi{t - a)) 

Jo 

■ ^ IIP W 11,2 B-Mi) + r|(-)yd/(-) da. 



(B.41) 
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Based on the result of Lemma B.4, the following inequality can be developed 

P~^ (t) > (0) exp (-Ai^) -h exp (-Alt) f exp (Aicr) da 

^1 L-'O 



/ 



+ / exp (-Ai (t - a)) Yjj (•) Ydf (•) da. 



After evaluating the bracketed integral given in (B.42), 
pression can be simplified as follows 



(B.42) 
the resulting ex- 






P UO) - ^-^3^ exp (-Alt) + L/g 



+ 




-Ai {t-a))Ylj{-)Ydf(-)da 



(B.43) 



To facilitate the remaining analysis, let the time interval [0,t] be divided 
into n different intervals where the length of the interval from U to 
is denoted by 6i (Le., length of the interval from to to ti is 6q, ti to t 2 is 

^1,...., tji to ^n-fl is Sfi). 

For the interval 0 < ^ < where ti = 6 q: Since the bracketed term 
in (B.43) is always positive, the following lower bound can be developed 






P ^ (0) - ^-^ 3 ^ exp {-Xit) + 



(B.44) 



Provided that the gain condition given in (2.64) is satisfied, the following 
fact can be utilized 



exp (-Alt) > exp(-Ai5o) Vt G [0,ti] 
to rewrite (B.44) as 

{t) > (p~^ (0) - exp (-Ai^o) + ^/ 3 . (B.45) 



For the interval t\ < t < t 2 where t 2 = {ti + ^i): Provided that the 
gain condition given in (2.64) is satisfied, the first term on the right-hand 
side of (B.43) will always be positive, and hence, the following lower bound 
can be formulated for (B.43) 



P-W>^/3 + 



rto 

Jto 



to-\-6o 



exp (-Ai {t - a)) Yjf (•) Ydf (■) da 



(B.46) 
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Since a used in (B.46) satisfies the inequality 0 < cr < and t in 

the interval ti <t < t 2 , it follows that t-a< 6 o-\-Si. Since t — a< 6 o + 6 iy 
the following inequality can be developed 



exp (-Ai {t - a)) > exp (-Ai (^o + ^i)) • 
Hence, (B.46) can be rewritten as 

/ to 



1 rto+^0 

P-'(0>W3 + exp(-Ai(5o + <5i)) / 

Jtn 



(B.47) 



(B.48) 



For interval tn < t < where tn+i = (^n + ^n)*» After extending 
the results of (B.46) and (B.47) to the interval tn <t < the following 
expression is obtained 



[5-1 



{t)>^h + 

ki 



it 



-l+^n 



exp (-Ai {t - cr)) YI (■) Ydf (•; 



(B.49) 



and 

exp (-Ai {t - a)) > exp (-Ai (5„_i 4- (5„)) . (B.50) 

Hence, (B.49) can be rewritten as 



P-I(t) 



> — J 3 + exp (-Ai (<5„_i 
fci 




'Ylj{-)Ydf{-)da . 



(B.51) 

If the PE condition given in (2.57) is satisfied, then (B.51) can be lower 
bounded as follows 



P ^ (t) > + exp (— Ai {6n-i H- Sn)) fJ'h > — h I 3 (B.52) 

where k is defined in (2.63). It should be noted that to obtain the expression 
given in (2.63), the interval 0 < t < and the minimum from the other 
intervals < t < ti were used where z = 2, 3, n. The lower bound on 
P~^ (t) can now be formulated as 



P~U^)> 



1 -h kiK 
ki 



/3. 



(B.53) 



Finally, by invoking Lemma B.4 the following expression is obtained 

p{t) < {p{t)}h = \\Pim,,h < 



(B.54) 
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Bounds for A {t): 

After applying the result given in (B.54) to (2.58), lower and upper 
bounds for A {t) can be formulated as follows 



Upper bound for P~^ (t): 

After applying the lower bound in (B.55) to (2.43), the following expres- 
sion is obtained 

(B.56) 

which can be further upper bounded by the following expression 



p-i(t)< P-1(0)+ 



(l - exp (-Ai (il^) t)) (1 + kiK) 



(B.57) 



XikiK, 



where the definition for the induced-infinity norm of a matrix is given in 
Definition A.l in Appendix A. The bracketed term in (B.57) can be upper 
bounded as 

(l-exp(-Ai jl + kiK) 

XikiK 



< 



(1 + fclAv) ^ 
Xik\K ’ 



(B.58) 



thus, (B.57) can be further bounded as 



(t) < P-^ (0) + 



Yifmf(-) 



(1 + kin) 



XikiK 



(B.59) 



Given that 6 d (t) and 9d (t) are upper bounded by some known positive 
constants, it can be shown that ||yd(-)||-^ defined in (2.38) can also be 
upper bounded by some known positive constant. Given the definitions in 
(2.37) and (2.33), the standard inequality property of convolution in [4] can 
be used to prove that 



r,/(-)iu<7rd(-)iiioo 



(B.60) 
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where the upper bound ||/ {t)\\ < 7 for (2.33) has been used. Since \\Ydf (OILoo 
in (B.60) is bounded, the following inequality can be applied to show that 
Ydf Ydf {■) is bounded: 

ioo 

\\AB\\i < II Alii Plli e e (B.61) 

where H-Hi denotes any induced norm of a matrix. Since Ydf (-)^ Ydf (•) 

ioo 

is bounded and P~^ (0) is a positive-definite symmetric constant matrix, 
there exists a positive bounding constant /c2 € M such that 

P-^{t)<k2h. (B.62) 

The result given in (2.75) can now be obtained from (B.53) and (B.62). □ 



B.1.5 Inequality Proofs 

In this section, proofs for the inequalities given in Property 2.7 are provided. 
The following facts are exploited to facilitate these proofs 



|cos a — cos 6| < 8 |tanh (a — 6) | 
|sina — sin6| < 8 |tanh (a — 6)| 



‘ Vn, h G M, 



(B.63) 



= . Va = [ai,a2,---,an]^ e 



Lemma B.6 The following inequality is valid for the transformed ship dy- 
namics of (2.95) 



\\M*{u) - M*{w)\\^^ < Cm \\Tanh{u - ■u;)|| Vu,w € 



(B.64) 



Proof: After substituting the definition of M*( ) given in (2.96) into 
(2.102), the following bound can be obtained 

||M*(u) - M*(tu)||^^ < max |m7u,u;)| Vj = l,2,3 (B.65) 

where M* (t) = [ M^(t) M^i^) ^3 (0 ] ^ is an auxiliary expression 

defined as follows 

Ml = |(mii — 77122) (sinus COSU3 — sinics cosics)! 

+77123 |sinu 3 - sinicsl 



+ I (77111 (cos^ 713 - cos^ W3) + 77122 (sin^ 7x3 - sin^ ^3)) | , 



(B.66) 
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M* = I (mil — '^22) (sin cos 1^3 — sin 1^3 cos w^) | 

-\-rri 23 I cos 1x3 — cosi(;3| 

+ 1 (^11 (sin^ U 3 - sin^ W 3 ) + 17122 (cos^ U 3 - cos^ '^3)) j , 

(B.67) 

M* = \rri 23 (cos 1^3 - cos 1^3)! + |m23 (sinii3 - sinu^3)| , (B.68) 

and 1^3 (^), W 3 {t) are the third elements of the vectors u{t), w{t) C 
respectively. After some algebraic manipulation, the expression given in 
(B.66) can be rewritten as follows 

M* = 1(^11 — ^7,22) ((COSU3 — cosw 3 )smu 3 -h (sinu3 — sinu;3) cosu;3)| 



+m23 |sinu3 — sin 1^3! 

+ Kn^ii ((COSU3 — cos 103) cos 7X3 -f (COSU3 — C 0 SW 3 )C 0 SW 3 ) 



+ rn22 ((sinu3 — sinrt;3) sinu3 + (sin 7x3 — sinu;3) sinu;3))| 

which can be upper bounded as follows 

< (|mii — m22| + 2mii) |cosxx3 — cos 1^3 1 

-H (rrx23 + 2m22 + \mu - rri22\) |sinxx3 - sinu;3| . 



(B.69) 



(B.70) 



After making use of (B.63), (t) can be further upper bounded by the 

following expression 

Ml < Cmi |tanh {ua - ws)! < Cmi II Tank {u - w)|l (B.71) 

where Cmi C R is a positive bounding constant. Likewise, similar bounds 
can be obtained for (t) and {t) of (B.67) and (B.68), respectively. 
These bounds can then be used in (B.65) to obtain the result given in 
(B.64). □ 



Lemma B.7 The following inequality is valid for the transformed ship dy- 
namics of (2.95) 

\\Vrn{u,f])-Vrn{w,r])\\^^<i;^ 2 \\'h\\\\Tanh{u-w)\\ \/u,weR^. (B.72) 

Proof: After substituting the definition of Vm (•) given in (2.96) into 
(2.102), the following bound can be obtained 

\\Vrn{u,fi) -Vrn{w,ri)\\-^< max fVrnj{u,W,T])'^ Vj = 1,2,3 (B.73) 
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where the elements of the vector Vm {t) = [ ^m3(0 ] ^ 

are defined as 

Vmi — '0 (^22 — '^ii) {sinus cos Us — sinws cosws) 

+ 'ip (mil (cos^ Us — cos^ ws) + rri22 (sin^ us — sin^ ws)) , 

(B.74) 

Vm2 = 'ip (mil (sin^ 1^3 ~ sin^ ws) + rri22 (cos^ us - cos^ ws)) 

(B.75) 

+ '0(m22 — mil) (sini/3COSi^3 — sinicacostca) , 

VmS= 'ip'm 2 s{cosus - cosws) 4- '0m22 (siniX 3 - sini/; 3 ) , (B.76) 

and us{t), ws{t) are the third elements of the vectors u{t)^ ic(^) G 
respectively. After some algebraic manipulation, the expression given in 
(B.74) can be rewritten as 

Vmi= ^(m22-mii) 

((COSU3 — cosu^3) sinu3 -h (sinu3 — sinu;3) cost(;3)| 

H- (mil ((cos Us — cos ws) cos us -h (cos 1x3 — cos ws) cos ws) 



4- m 22 ((sin us - sin ws) sin us -f (sin us - sin 1 ^ 3 ) sin u; 3 )) | 



which can be upper bounded as 



Vmi < I'ipl |m 22 - mill (|cosu 3 - cosii^ 3 | -h |sinu 3 - sinu; 3 |) 



+2 |'0| mil ICOSU 3 — cosrc 3 | 4- 2 rri22 |sinrx 3 — sin'u; 3 | . 

(B.78) 

After making use of (B.63), Vmi{t) can be further upper bounded by the 
following expression 



Vmi < Cpi 'ip |tanh(u 3 - xx; 3 )| < || 77 || \\Tanh{u - u;)|| (B.79) 



where G M is a positive bounding constant. Likewise, similar bounds 
can be obtained for Vm2 (0 Kn 3 (0 (B.75) and (B.76), respectively. 

These bounds can then be used in (B.73) to obtain the result given in 
(B.72). □ 
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Lemma B.8 The following inequality is valid for the ship dynamics of 
(2.95) 

||Fi(7i) - Fi{w)\\ < C /2 \\Tanh{u - w)\\ \/u,w G (B.80) 

Proof: The proof of (B.80) is straightforward from (2.92), (2.96), and 
the proof of Lemmas B.6 and B.7. □ 

B.1.6 Control Signal Bounds 

Lemma B.9 The auxiliary control signal x(0 (2.130) can he up- 

per bounded by the following expression 

llxll < Cl Ikll + C 2 Ikll" + C3 Ikll" + C4 Ikll" + Cs + Ce Ikll Ikll (B.81) 

where the composite state vector g{t) was defined in (2.137) and G R, 
z = 1 , . . . , 6 are some positive bounding constants that depend on the system 
parameters and the desired trajectory. 

Proof: To prove Lemma B.9, the norm of (2.130) is used to obtain the 
following upper bound 

llxll < |1M*(7,)|| 11(705/1-2 (e)|| II (r - Tanh{e) - ^)|| 

+ l|M*(r;)||||T|| \\{z - Tanh{e))\\ 

+ \\Vm{r],Vd + Tanh{e) + ^)|| \\{Tanh{e) + z)|| (B.82) 

+ \\Vm{ri,f]^)\\ l|(Tan/i(e) + z)|| 

+ \\Vm{v,r)\\ ||(r/d + Tanh{e) + 2 )|| . 

After utilizing (2.97), (2.100), and the fact that |cosh“^(-)| < 1, (B.82) can 
be upper bounded as follows 

llxll < m 2 (||r|| + ||ron/i(e)|| + ||z||) 

+m 2 ||r||(||z|| + ||Tan/i(e)||) 

+C .1 (ll^dll + \\Tanh{e)\\ + ||z||) {\\Tanh{e)\\ + ||z||) (B.83) 

+C ,,1 ll^dll {\\Tanh{e)\\ + \\z\\) 

+C.ilM|(||f/,|| + ||Tan/i(e)|| + ||z||). 
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To facilitate further analysis, the definition of T (•) given in (2.132) can be 
used to prove that the following inequality is valid 

||T|i < (l + lkll')'. (B.84) 

The result given in (B.81) is now straightforward after substituting the 
inequality given in (B.84) into (B.83) for ||T(-)|| and then using (2.137) 
and the facts that |tanh(*)| < 1 and is bounded. □ 

Lemma B.IO The auxiliary control signal Y {’) given in (2.129) can be 
upper bounded as follows 

|i^||<C7lkll (B.85) 

where is some positive bounding constant that depends on the system 
parameters and the desired trajectory. 

Proof: To prove the result given in (B.85), we substitute (2.127) into 
(2.129) for Yd{-)(t> to obtain the following expression 

Y = [M*{ri) - M*{r}j)\r}^ + ~ Kn(r/d,T?d)] 

(B.86) 

+ - FiMVd] + [Fi{r])'hd - Fi{r]d)r]d] 

where the term Fi (7^)77^ has been added and subtracted. After utilizing 
(2.101), (2.102), (2.106), and (2.120), an upper bound can be formulated 
for (B.86) as follows 

|y|| < C II Tank (e)|| \\nd\\ + U II Tank (e)|| ||r?d||" 

(B.87) 

Cyi (||r|| + II Tanh{e)\\ + ||z||) + C/ II Tanh (e)|| ||^,|| . 

The result given in (B.85) follows directly from (B.87), given (2.137) and 
the fact that 77^ (t) and 77^ (t) are bounded. □ 

Remark B.l Note that if the mooring effects are included in the dynamic 
model of the surface ship, the expressions given in (2.138) and (B.85) could 
not be used to upper bound Y(t). 

B.l. 7 Matrix Property 

Lemma B.ll Given the definition for the J acobian-type matrix B(q) given 
in (2.177), the following property holds 

B^B = I 3 (B.88) 



where Is is the 3x3 identity matrix. 
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Proof: The definition for B{q) given in (2.177) can be written in the 
following form 






-Qvl 


~9v2 


9v3 


90 


-qv3 


Qv2 


Qv3 


Qo 


Q.vl 


_ 9v2 


qvl 


90 



(B.89) 



Based on the structure of (B.89), we can utilize (2.170) to prove (B.88). □ 



B.2 Chapter 3 Definitions and Lemmas 



B.2.1 Supplemental Definitions 

Definition B.l The measurable functions Vi = 1,2, 3, 4 introduced 

in (3.75) are defined as follows 






didj ■ . Bj{q, Ij) dlfij 

Lj{q,Ijy dTd 



“ 1 “ 



+ksaqd + 



dTd 

dMm 






pTd 

d9m 




^ didj dTd 

Q = 



(B.90) 



^ j — 



dIdj d 
dTd dq 



'^rj{q,Ij). 

i=i 



B.2. 2 Stability Analysis for Projection Cases 

Lemma B.12 Given the mechanical and electrical closed-loop error sys- 
tems in (3.69) and (3.78) as well as the adaptive update laws given in 
(3.80-3.82), an upper bound for the expression given in (3.89) can be for- 
mulated as follows 
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Proof; After utilizing (3.65), (3.77), and (3.80), the expression in (3.89) 
can be rewritten as follows 

m 

y = -Ky - E KejMmVj 

j=l 

+Mm ^ E (-M-1 + n2jWm0m + Uj) 7?,) ^ (B.92) 

+Mm (^{<id + ae)r- Mm'^ . 

To substitute (3.81) and (3.82) into (B.126) for Mm {t), the three following 
cases must be considered. 

Case 1: Mm (t) > 

When Mm (0 > Mm? fi^st equation in (3.81) can be used to express 
V (t) as follows 



V < -K^ -Y^KejMmv] < -h Ikil^ (B.93) 

J = 1 

where (3.91) and (3.92) have been utilized. Thus, for Case 1, we can con- 
clude that (3.89) reduces to the expression given in (B.91). In addition, the 
direction in which the estimate Mm (t) is updated for Case 1 is irrelevant, 
since the worse case scenario is that Mm (t) will move toward M^ which 
will be covered in Cases 2 and 3. 

Case 2: Mm = M.m > 0 

When Mm if) = Mm ^m{t) equals the lower bound) and f^m is 
nonnegative, the second equation in (3.81) alongside (3.82) can be used to 
express V (t) as follows 



y < -Ksr^ - Yl KejM^ri] < -A 3 ||a;||2 . (B.94) 

where (3.91) and (3.92) have been utilized. Thus, for Case 2, we can con- 
clude that (3.89) reduces to the expression given in (B.91). Geometrically, 
Mm{t) is updated such that it moves away from the boundary case of 
Mm (t) = Mm region given by Mm (0 > Mm- 

Case 3: Mm = M_m < 0 

When Mm (t) = M.m (i -^-5 Mm (t) equals the lower bound) and Clm is 
negative, the third equation in (3.81) alongside (3.82) can be utilized in 
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order to express V {t) as follows 

m 

V = -KsT^ - iz KejMmV'j 
j = l 

+Mm ( + ^2jWm0m + Mj) Vj') + (% + Oce) r 

(B.95) 

By definition, the following relationships must hold for this case 

Mm{t)^Mm-M^>0. (B.96) 

Moreover, the parenthesized term in (B.95) can be written as 

m 

+ ^2jWm^rn + "h {qd + O^e) V = Ti ^Qrn < 0 

j=l ^ 

(B.97) 

where we have utilized (3.82) and the fact that Fi > 0 and Qrn < 0. Prom 
(B.96) and (B.97), it is clear that the second line of (B.95) is negative, and 
hence, (B.95) can be lower bounded as follows 

m 

V < -KsV^ - J2 KejMmri] < -As Ikll" (B.98) 

j = l 

where (3.91) and (3.92) have been utilized. Thus, for Case 3, we can con- 
clude that (3.89) reduces to the expression in given in (B.91). Geomet- 
rically, this case ensures that M^(t) stays on the boundary defined by 
(t) = as long as it is not directed to move into the prescribed 
region for Mjn as defined in Remark 3.4 of Chapter 3. □ 

B.2.3 Dynamic Terms for a 6-DOF AMB System 

The dynamic equation for the center of mass of the circular cylinder rotor 
with respect to the fixed coordinate frame (x^, ?/ 5 , Zf,) can be written as 
follows [ 1 ], [3] 

M*(g*)r + v:.{q\r)r + g* = f* (b.99) 

where q* - [ x^, y^, z^, <f>, 9, ip € K®, {xl,yl,zD denotes the 

position of Oq with respect to 05 (see Figure 3.11), denote the 

Euler angles,^ and F* e R® is the force/ torque vector. The dynamic terms 

^The orientation of the rotor is given by a series of three rotations. Assuming that 
the rotor is initially oriented so that the moving coordinate frame (xq, 2/0, -^o) is aligned 
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in (B.99) are defined as follows [1], [3] 

=diag{m/3, r-^OT-i} G 

C?* = [ 0, 0, mg, 0, 0, 0 € R® 



(B.lOO) 



(q*,q*) = diag |mi? (^-R~^RR-^ + r-^S , 



r-^ (-OT-irr-i + r-^5 (nj hv-^'^ } € r®"^® 



(B.lOl) 

where m is the mass of the rotor, g is the gravitational constant, I 3 repre- 
sents the 3 x 3 identity matrix, S G is a skew-symmetric matrix 

with 0 , ' 0 ] ,i/GR^^^ denotes the diagonal inertia matrix of 

the rotor with respect to the {xo, Vo^Zo) axes, and F, i? G R^^^ are defined 
as follows 






1 sin(0) tan(^) cos(0) tan(^) 
0 cos(0) — sin(0) 

0 sin(0) sec {9) cos(0) sec {0) 



(B.102) 






C (0) c{9) c{^l;)s{9)s{(t)) - 5(0)c(0) c(0)5(0)c(0) + s(0)5(0) ‘ 
5 (0) C((9) 5(0)5(6>)5(0) + C(0)c(0) 5(0)5(6>)c(0) - c(0)s(0) 
-s{9) c{9)s{(t)) c{9)c{4)) 



(B.103) 

with c(-) ,s (•) denoting the cosine and sine of the argument, respectively. 
The kinematic relationship between the position vector q{t) defined in Sec- 
tion 3.4.1 of Chapter 3 and g* of (B.99) is defined as follows 



-h (d - zl) I c(0) tan(0) -h 
Vb-^id- z^) (s{^) tan(l9) + 



q 



5(0) tan( 0 ) 
c{9) 

c( 0 ) tan( 0 ) 

w~ 



^b-^b[ c(V') tan(6») + 



Vb - H 



- 2 



f{q-) (B.104) 



with the fixed coordinate frame (^5, 275,^5), the rotations are defined as follows [1]: (1) 
a rotation 'ip about the Zq axis, (2) a rotation 6 about the current yo axis, and (3) a 
rotation (p about the current Xo axis. 
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where d G R denotes the distance between the origins Ob and Ot measured 
along the axis (see Figure 3.11), and L G R is the length of the rotor. 
Prom (B.104), the dynamic quantities defined in (3.60) can be explicitly 
calculated as follows 



M{q) 

G(q) 



- J-'^{q)M\q)J-\q) 



- T-T 



J-^{q)G* 



Vm{q,q) =J-^(q) J-i(g) j(g) + V;; (g, g) J~\q) 



J{q) = 



= J-^{q)F* 

df{q) 



(B.105) 



dq 

q*{q) =f~\q) 

where /(•) was defined in (B.104). 

B.2.4 Partial Derivative Definitions 

Definition B.2 The partial derivative expressions required to complete 
( 3 . 143 ) are defined as follows 



= M{q)a + Vm{q,q) + k,X2{q)h 



dqd 

^ = Vm{q, q)a + ks\2{q)al6 



(B.106) 



dw d\2 , , / N 

8 , = + 



dq 

dfd _ dw , . . w 
dq dq ® 



where I Q denotes the 6x6 identity matrix. In (B.106), the partial derivative 

dG{q) 



dw (') dw (') 

terms — — and — ^r: — are defined as follows 



dq 

dw 



dq 



dq "^"^^^^Xi) + A2iq,C2)-Vm{q,q)a+ 



(B.107) 
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— = -M(g)a + A3(^,C3) (B.108) 

where the auxiliary terms Ai(g, A 2 {q, C 2 )? ^ 3(^5 C 3 ) ^ defined 

as follows 



^i(9>Ci) 



dMjq) dM{q) 

dqx ■■■’ dqe 



Ci= 9 d + Q:e (B.109) 



■^2(9! C2) 



dVm{q,q) 

dqi 



C 25 



■^siqXs) 



dVm{q,q) 

dqi 



Cs) 



dVm{q,q) 

dqe 

dVm{q,q) 

dqe 



C 2 ) 

Ca- 



C2~qd + ae 

(B.llO) 

Cs = + ae. 

(B.lll) 



B.3 Chapter 4 Lemmas 

B.3.1 Inequality Lemma 

Lemma B.13 Based on the definition of satp (•) given in (f.lS), the fol- 
lowing inequality can he obtained 

(^li ~ ^2i) — (^li) ~ (^2i)) 11 

Proof: To prove the inequality given in (B.112), the proof is divided into 
three possible cases. 

Case 1: |^i^| < /3i,|^2il < Pi 

For this case, the definition of sat^. (•) given in (4.13) can be used to 
prove that 

(^ii) — sat^. (^2i) — ^2i • (B.113) 

After substituting (B.113) into (B. 112 ), the following expression can be 
obtained 

(^H-^2i)^= (saV,(^H)-sat^.(^2^))" ^\^ii\<0iA^2i\<Pi, (B.114) 

and hence, the inequality given in (B.112) is true for Case 1 . 

Case 2: > Pi 

For this case, the definition of sat/ 3 . (•) given in (4.13) can be used to 
prove that 



(^2i+/3J>2^H '^\iu\<Pi,i2i>Pi- 



(B.115) 
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After multiplying (B.115) by (^ 2 i ~ 0i) simplifying the left-hand 

side of the inequality, (B.115) can be rewritten as 

(B.116) 

where the fact that ^ 2 i “ > 0 has been used for this case. After adding 

to (B.116) and then rearranging the resulting expression, the following 
inequality can be obtained 

i\i - + & > fli - mu + Pi ■ (B.117) 

Based on the expression given in (B.117), the following facts 

sat/3, (^li) = sat/3,, (^2i) = Pi (B.118) 

can be used to prove that 

(^li - ^2if > (sat/ 3 , (^li) - sat/ 3 , (^2i))^ < Pui2i > Pi ■ 

(B.119) 

Case 3: < /?j,^2i < ~Pi 

For this case, the definition of sat^. (•) given in (4.13) can be used to 
prove that 

(C2i - Pi) < m VI^hI < /3/,^2i < -Pi • (B.120) 

After multiplying both sides of (B.120) by {^2i + l^i) then simplifying 
the left-hand side of the inequality, the following inequality can be obtained 

f2i-Pl>^i^2i + Pi)^li (B.121) 

where the fact that ^ 2 i + < 0 has been utilized for this case. After adding 

to (B.121) and then rearranging the resulting expression, the following 
inequality can be obtained 

fu - 2^u^2i + ili > fu + mu + Pi ■ (B.122) 

Based on the inequality given in (B.122), the following facts 

sat/3, (^li) = sat/3, (^2i) = -Pi (B.123) 

can be utilized to prove that 

(^li - C2i)^ > (sat/ 3 , (^li) - sat/ 3 , (^2i))^ < 0i,^2i < -Pu 

(B.124) 

hence, (B.112) is true for all possible cases. □ 
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B.3.2 Stability Analysis for Projection Cases 

Lemma B.14 Given the closed-loop dynamics in (4.102), (4.113), and 
( 4 . 114 )} if0m{0) G int(A), then Om{t) never leaves the region A described 
in Property 4-0, Vt > 0^ and an upper bound for the expression given in 
( 4 . 117 ) can be formulated as follows 

V < -kr^r-kelex. (B.125) 

Proof: To prove Lemma B.14, the closed-loop dynamics given in (4.102) 

and (4.113) can be substituted into (4.117) for 9\ {t) and 62 (t), respec- 
tively, to obtain the following expression 

V <-k (r^r + elex) - €^^^^2^2 + C • (B.126) 

tl Um 

To substitute (4.114) and (4.112) into (B.126) for 6m (t), the following 
three cases must be considered. 

Case 1: 6 m(t) G int(A) 

When the parameter estimate 0^(t)lies in the interior of the convex 
region A, described in Property 4.6, (B.126) can be expressed as follows 

v< -k (r-Tr + ele,) - [ya] ’’ «x) - 

(B.127) 

Thus, for Case 1, (4.117) reduces to the expression in given in (B.125). In 
addition, the direction in which the estimate 6m{i) is updated for Case 1 
is irrelevant, since the worst case scenario is that 9 mil') will move towards 
the boundary of the convex region denoted by 9(A). 

Case 2: 9mit) ^ 9(A) and fijit)9'^it) < 0 

When the parameter estimate 9m{t)^^^^ on the boundary of the convex 
region A described in Property 4.6 and /if(t)0^(t) < 0, then (4.117) can 
be expressed as (B.127). Thus, for Case 2, we can conclude that (4.117) 
reduces to the expression in given in (B.125). In addition, the vector /Xift) 
has a zero or nonzero component perpendicular to the boundary 9 (A) at 
9 mil) that points in the direction towards the int(A). Geometrically, this 
means that 9mit) is updated such that it either moves towards the int(A) 
or remains on the boundary. Hence, 9m{t) never leaves A. 

Case 3: 9m{t) ^ 9(A) and /aJit)9^it) > 0 

When the parameter estimate ^^(t)lies on the boundary of the convex 
region A described in Property 4.6 and /if(t)^^(t) > 0, then (4.117) can 
be expressed as 

V<-k {r^r + elex) - (-^i + 



(B.128) 
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where (4.112) was utilized. Based on (B.128), Property 4.6 can be used to 
conclude that 



Vi < — /c (r^r + c^ca) 

-C (- + PUMi)) + P^r (Ml)) 

< -k{r'^r + e{ex) + ~e^P^{^ll)■ 



(B.129) 



Because 6m(t) G 9(A), and 6m must lie either on the boundary or in the 
interior of A, then the convexity of A implies that 6m{t) will either point 
tangent to 9(A) or towards int(A) at 9m{t)- That is, 9m{i) will have a 
component in the direction of 9^(t) that is either zero or negative. In 
addition, since P^()^i) points away from int(A), the following inequality 
can be determined 



< 0 . 



(B.130) 



The inequality given in (B.130) can now be used to simplify the expression 
given in (B.129) to the expression given in (B.125). Furthermore, since 

9m {i) = parameter estimate 9m{i) is ensured to be updated 

such that it moves tangent to 9(A). Hence, 0rn(O never leaves A. □ 



B.3. 3 Boundedness Lemma 

Lemma B.15 The second time derivative of the force tracking error e\{t) 
defined in (f.l33) is hounded (i.e., e\ G Coo)- 



Proof: To prove Lemma B.15, the open-loop dynamics for the force 
tracking error c\{t) of (4.133) are rewritten as follows 



6a = Ad - n-^T2 + n-^ [V^2lUl + N 2 ) 
+n-^M 2 iMf/ [ri - - M] . 



(B.131) 
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After taking the time derivative of (B.131), the following expression for 
e\{t) can be obtained 

e\ = — ^2 - T2 +— (n~^) {Vm2lUl + N2) 



+n ^ (v m 21 + Vm 2 lUl-\- N 2 ^ 

+ j ^ (n-’’) M21M1V (^1 - ^*11^1 - ^1) 

+n~^ M 2 I (ti - VmllUl - Ni) 

+n-^M 2 i^ (Mn^) (fi - VmllUl - Ni) 

+n~'^M2lMil ^Ti - Vmll Ul - VmllUl- N . 

(B.132) 

Since ui{t), and e Coo from the proof of Theorem 4.3, standard 
signal chasing arguments can be used to prove that all of the signals on 
the right-hand side of (B.132) are bounded, however, special care must be 
directed towards proving that fi (t), T 2 (t) G Coo- To this end, the time 
derivative of fi{t) given in (4.107) can be obtained as follows 



f^=Y^0^^Yi h -kr. 



(B.133) 



Since the desired position trajectory is assumed to be bounded up to its 
third time derivative and e(t), e(t), e{t) e Coo, the regression matrices 

Yi (•), Yi (•) G Coo- Since h (t), r{t) e Coo, (B.133) can be used to prove 
that fi {t) e Coo- After taking the time derivative of f 2 {t) given in (4.107), 
the following expression can be obtained 



T2 = 



^ (¥ 292 ) + (y^h) 

dt WOmJ ^ ^ hTOm ^ > 

(¥ 2 ^) + + n^— e,. 

dt\ ) m. rUd 



(B.134) 



Prom the proof of Theorem 4.3, e\{t), e\{t), 11^(3:), n^(^), Y 2 (•) ^2(0, and 
^ (y 2 ^ 2 ^ are all bounded. Since the projection-based parameter update 



law for 6m{i) given in (4.111) ensures that {u)6m{t) > 0 (see the devel- 

\ hnmY '] 



opment in Lemma B.14), — 

dt 



also remains bounded; therefore. 
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(B.134) can be used to prove that T 2 (t) G Coo- The fact that all of the 
terms on the right-hand side of (B.132) are bounded can now be used to 
prove that ex{t) G Coo- D 

B.3. 4 State-Dependent Disturbance Bound 

Lemma B.16 Given a function F (x) G and a variable x(t) G 

such that 
dF-(x) 

— G £oo if x{t) e Coo, Vi = 1, j = 1, ...,n (B.135) 

where Fij (x) represents the ij^^^ element of F{x), then 

F = ||F {xd) - F (x)|| < pf {\\xd\\ , pll) \\x\\ (B.136) 

where x{t) G R^ represents the mismatch between Xd{t) G R^ and x{t) as 
follows 

x = Xd~x^ (B.137) 

and pj{')£'Risa positive nondecreasing bounding function. 

Proof: To prove Lemma B.16, the element of F{x) is first defined 
as follows 

Fij = Fij {xdi,xd2, ---,Xdk) - Fij (xi,a:2, . (B.138) 

After adding and subtracting the terms Fij[x\^ Xd 2 , Xdk), Fij{x\., X 2 , 
Xd3, Xdk), ---, Fij{xi, X 2 , Xfc-i, Xdk) to the right-hand side of (B.138), 
the following expression can be obtained 

Fij \Fij {^Xd\’)Xd2’> ‘-"jXdk^ Fij {x\^Xd2) --••jXdkf\ 

(^1 5 ^d2 , Xdk^ Fij (xj , X2 , XdS , - ^d/c)] d" • • • 

d~ [Tij (^1 5 X2 , • • • , Xk — \ , Xdk^ Fij fx\ , X2 5 • • • , Xk—\ , ^fc)] • 

(B.139) 

After applying the Mean Value Theorem (given in Lemma A.l of Appen- 
dix A) to each bracketed term of (B.139), the following expression can be 
obtained 

F- — •■■,Xdk) I 

ij — \ai=vi \Xdl >^1) 

+ ^ \a2=v2 (Xd2 - X 2 ) (B.140) 

+ + ( 3 : 1 , ^2, ■■■,Xk-l,0'k) I . . 

T- ... T ^ \(Tk=Vk \Xdk Xk) 




370 Appendix B. Supplementary Lemmas and Definitions 



where Vi{t) has a value in between Xi{t) and Xdi(t) for i = 1,2, To 
simplify the notation, (B.140) is rewritten in the following matrix form 



~ dFij (a,x,xa) 



\cr=v {^d 



(B.141) 



where 



(7 [(7l , . . . , CT/c] , 



V = [vi, , 



(•) 

da 



dFi^ dFi, 



dai ’ dak 



From (B.141), the following upper bound for Fij{x) can be obtained 







F 


< 



dFjj {a,x,Xd) 
da 



a=v 



||a:d - X 



By noting that 



Vi ~ Xdi - CiXi \/ci G (0, 1) , 2 = 1, 2, ...A:, 



(B.142) 



(B.143) 



an upper bound for 
(B.142) as follows 



Fij{x)\ can be developed from (B.135), (B.137), and 







for z = 1, ..., m, j = 1, ..., n 



(B.144) 



where (•) is some positive nondecreasing scalar function. The result given 
in (B.136) can now be obtained. □ 



Lemma B.17 Given the expressions in (4-130) and (4-134), Lemma B.16 
can he utilized to construct the following inequality 



p(Cdp,Cd„,Cda.ll2/ll) IIj/II > max|||x|| 




(B.145) 



where and were defined in (4-86), y{t) is given in ( 4 - 14 ^), 

and p[-) G M is a positive nondecreasing function. 



Proof: To prove Lemma B.17, the result in (B.145) is first developed for 
Yv{-)- Based on the proof for the result in (B.145) for Yv{'), the proof for 
x(-) can then be obtained. To this end, the expression given in (4.135) can 
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be substituted into (B.146) for (•) 9y to obtain the following expression 

Yy = + n~^M2iac(7(Mii)y^ii(ui, Ui)e 

Z uu\ 

+II“^M 2 iadj(Mii) [Vmll (ui,Udl) - Vmll (wi,ui)j Udi 
+n~^M2iadj(M^ii) [Ni{ui,udi) -M(«i,ai)] 

- det{Mn)Il~'^Vm2i{ui,ui)e 



dat(Afii)II [^^21 (ai , W(ii) ^'^21 (ai , ai)j 



-det(Mii)n ^ [Ar2(wi,a<ii) ~ N2(ui,ui)] 

(B.146) 

where common terms have been cancelled, and several terms have been 
added and subtracted from the resulting expression. After invoking Lemma 
B.16, the following upper bound can be formulated 



Y, 


< 1 


a(det (Mn)) 


V 


- 2 


dui 



Pil IkA 



+ ||n-^M 2 iadj(Mn)|| pmii(ai, ai)|| ||e|| 

+ ||n-^M2iadj(Mn)|| 

• (P.idlaill , O., Pll) ||e|| O. + Pnidhiil , Cd., I|e||) l|e||) 



+ ||det(Mii)n-^|| 

• (||t^m2i(ai,ui)|| ||e|| +p„2d|ai|| ,Cdt,, l|e||) PH Cdt;) 



+ ||det(M„)n-^||p„2(IPiPU.I|e||)||e|| 

(B.147) 

where (4.86) has been utilized and Pvi{') , Pv2i') ^ Pnii') ^ Pn2 (') ^ ^ some 
positive nondecreasing bounding functions. The remaining matrix norms of 
(B.147) can also be bounded by some positive function, hence 




^ PidPill . I|e||) lleAll +P 2 (l|ai|| , H^i || , Cdt,, ||e||) ||e 



(B.148) 



where Pi(*))P 2 (') ^ ^ some positive nondecreasing bounding functions. 
To express (B.148) in terms of y{t) and the constant motion trajectory 
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bounds of (4.86), the expressions given in (4.92), (4.86), and (4.128) can 
be used along with the following inequality 



IIj/II > INM|e/IUMU|e,ii 



to formulate an upper bound for 



n(-) 



as follows 



< Pi(Cdp, l|y||) \\y\\ + P2(Cdp. Cdv, bll) \\y\\ < PwiCdp> Cdv> Ibll) II2/II 

(B.149) 

where p^(-) G E is some positive nondecreasing bounding function. Using a 
similar procedure, the following upper bound can be formulated for ||x (’)ll 



llxll <Px(U.O.,U.IIJ/ll)ll2/ll (B. 150 ) 

where p^(-) G E is some positive nondecreasing bounding function. The 
result given in (B.145) can now be directly obtained from (B.149) and 
(B.150). □ 



B.3.5 Matrix Property 

Lemma B.18 Providing the following condition is satisfied 



cos (9) > 



~ f^2 
/?! + /?2 



(B.151) 



the matrix BR-\-{BR)^ will be positive- definite, where B and R are defined 
in (4-157) and (4-158), respectively. 



Proof: To prove Lemma B.18, the definitions for B and R given in 
(4.157) and (4.158), respectively, can be used to obtain the following sym- 
metric matrix 



= - [ PiCOsO sin 6»+ i/32 sin 6» ■ 

2^ ^ z — sin0 -f ^/?2 sin0 /? 2 cos 0 

(B.152) 

Using standard linear algebra techniques, the eigenvalues of (B.152) can be 
determined as follows 



— — ((/?i + P2) ^0 d- (Pi — P2)) j 

^2 = {{Pi +P2 )cos6q - {Pi -P2)) 



(B.153) 



where denotes the i^^ eigenvalue. For the symmetric matrix of (B.152) 
to be positive-definite, the eigenvalues given in (B.153) must be positive. 
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From (B.153) and the fact that A, 2;, /?2 > 0, the following eigenvalues 

can be proven to be positive provided 

Ai > 0 ^ cos (6»o) > 

Pi ”• P2 

(B.154) 

A 2 > 0 ^ cos(0o) > j_ - a - 

Pi P2 

Hence, if the condition given in (B.151) is satisfied, the matrix BR-\-{BR)^ 
will be positive-definite. 



B.4 Chapter 5 Lemmas 

B.4.1 Skew- Symmetry Property 

Lemma B.19 The transformed inertia and centripetal- Coriolis matrices 
introduced in the dynamic model given in (5.26) satisfy the following skew- 
symmetric relationship 

= 0 (B.155) 

Proof; In order to prove (B.155), we first take the time derivative of 
(5.25) and then utilize (5.28) to obtain the following expression 

+2f ( + 2T-^ ( JT-ie^,) T-^) ^ (B.156) 
= 2^^ JT-i + T-'^ ^ 

where the fact that 

(JT-^Cy ) "" = 0 (B.157) 

has been utilized. Based on the expression given in (B.156), the following 
property can be used to prove the result given in (B.155) 

t = -Tf-^T. (B.158) 

□ 
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B.4.2 Control Signal Bound 

Lemma B.20 Given the definitions in (5.23), (5.66), and (5.67), the fol- 
lowing inequality can be developed 

X<p(lkll)lkll (B-159) 

where z{t) is defined in (5.69). 

Proof: After substituting (5.64) and (5.66) into (5.67), the following 
expression can be obtained 

x= r^C*(e./+e.)+r^jd77-e,+ A 

V (b. 160 ) 

-2T'^J*e„f + T'^JCjd + Jwd - T^iV*. 

By taking the norm of (B.160), the following inequality can be developed 

Ilxl|< ||T^C*||(|Kyl| + |K||) 

+ l|r^^iflM + l|e.||+ ^ ) (B.161) 

y (i e^e^j y 

+2||r^J*||||e,/|| + ||V’i| 

where 'ip (t) £ is defined as follows 

^ = + (B.162) 

After substituting (5.29) into (B.162) for N* (•) and utilizing (5.60) and the 
fact that a^b = —b^a Va, 6 G the following expression can be obtained 

Ip = - (^RvJd^ J - J {Rjjp I (r? - - e„/) 

+ {t'^J -\JR)wd + ]^ JiJd - [^d ) "" J^c) . 

(B.163) 

By utilizing (5.12), (5.34), and (5.23) the following inequahty can be de- 
veloped 

||'0|| < Pi (e-u) (ll^^ll + ||e^|| + l|e^/||) -f P 2 (^t;) ^ ^ ^ (B.164) 
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where Pi(-)jP 2(’) some positive nondecreasing functions. Since (5.34) 
ensures that — e'^Cy is always positive and real, multiplying and di- 
viding the last term in (B.163) by y/l — e'^ey facilitates the structure of 
(B.164). Based upon the definition of (5.23), (5.25), (5.28), (5.34), (5.69), 
and (B.164), the expression in (B.161) can now be simplified to yield the 
result found in (5.68). □ 
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B.5.1 Definitions for Dynamic Terms 

Definition B.3 The components of the dynamic model given in (6.1) M {q) 
G C and G{q) G are defined as follows 



M 



rup + mr + rUc 

0 

mpL cos 0 smcj) 
mpL sin 9 cos (j) 



0 

rUp + me 

mpL cos 9 cos 0 
—mpL sin 9 s\n(j) 



(B.165) 



mpL cos 9 sin (f) 
mpL cos 9 cos (j) 
mpLi^ + 1 
0 



mpL sin 9 cos (j) 
— mpL sin 9 sin (j) 
0 

mpLp' sin^ 0 + / 



Vm = 



0 0 —mpL I sin 9 sin (j)9 — cos 9 cos (fx))] 

0 0 — mpL f sin0cos</)0 + cos0sin0(/)] 

0 0 0 

0 0 mpL?" sin 9 cos 9 (j) 



(B.166) 



mpL ^cos 9 cos (pb — sin 9 sin 
—mpL ^cos 9 sin pb + sin 9 cos 
—mpL^^ sin 9 cos 9(p 
mpL^ sin 9 cos 99 



and 



G = [ 0 0 mpgL sin 9 0 ^ . 



(B.167) 
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B.5.2 Linear Control Law Analysis 

Lemma B.21 Given the linear controller of (6.25), the time derivative of 
the following function 

V = ksE + e (B.168) 

is given by the following expression 

V = 0 (B.169) 



only when 



E{q,q) ^e(t) == 0 



(B.170) 



where E{q,q) and e{t) are defined in (6.21) and (6.2f), respectively. 



Proof: To prove Lemma B.21, we define the set of all points where 
(B.169) is satisfied as F. In the set F, it is clear from (6.29) and (B.169) 
that 

r{t) = 0 r{t) = 0, (B.171) 

and hence, we can conclude from (6.16), (B.168), (B.169), and (B.171) that 
x{t), y(t), and Vi(^) are constant, and that 



x{t) = 0 y{t) = 0. 



(B.172) 



Furthermore, (6.22), (6.24), and (B.171) can be used to prove that 

E{q,q) = e{t) = 0. (B.173) 

Based on (B.173), E{q,q) and e{t) are constant, and hence, from (6.25) 
and (B.171), we can prove that F{t) is constant. To complete the proof, 
the stability of the system must be analyzed for the cases when 0 — and 
when 0/0. 

Case la: b[t) = 0 and (j){t) = 0 

Based on the proposition that 6{t) =0 and (j){t) = 0, it is straightforward 
to prove that 

6{t) = 0 0(0 == 0. (B.174) 

By rearranging the first two rows of the expression given in (6.1), the 
following expressions can be obtained 

F; mp + m^+mc.. . n ^ . '1 • ± /-o 

= — X + 0cos0sm0 -h 0sm0cos0 (B.175) 

mpL mpL 

— ^0^ + 0^^ sin 0 sin 0 -h 200 cos 0 cos 0 
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JT' jYl — 1 — 777 •• •• 

— ^ — E — :^y 9cos6cos(f) — (j)sin6sin(f) (B.176) 

rripL rripL 

— (^6^ + sin 6 cos (p — 26(j) cos 9 sin (p. 

Based on the expression given in (B.172), (B.174-B.176), and the proposi- 
tion that 9{t) = 0 and 0(t) = 0, the following expression is obtained 

F,{t)=Fy{t)=0. (B.177) 

From (6.19), (6.25), (B.171), and (B.177), it is clear that 

e(t) =0. (B.178) 



Furthermore, by rearranging the third row of the vector given in (6.1), the 
following expression can be obtained 



9 = 730^ sin 9 cos 0 — 72 sin 0 9siii(p-\-y cos 9 cos cp) 

TTXp Jj "F 7 

(B.179) 

where (6.2-6.3) were utilized, and 72>73 C R are positive constants defined 
as follows 

rUpgL 



72 



rripL^ + 1 



73 = 



rripL^ 



rripLP' -|- I * 



(B.180) 



Based on (B.172), (B.174), and the proposition that '<p(t) = 0, (B.179) can 
be used to prove that 

sin0 = O, (B.181) 

and hence, from (6.6), it is clear that 



9{t) - 0. 



(B.182) 



Given (B.178) and (B.182), the expressions given in (6.16), (6.21), (6.23), 
and (6.24) can be used to prove Lemma (B.21) under the proposition that 
9{t) = 0 and 0(t) = 0. □ 

Case lb: 9(t) = 0 and '<p(t) ^ 0 



By rearranging the fourth row of the vector given in (6.1), the following 
expression can be obtained 

//IX*; ^ / :r sin 0 cos d) — sin 0 sin d) 

-^^{9)(p = -29(psm9cos9 - f 

where 7^ {9) G R is defined as follows 



(B.183) 



(B.184) 
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Based on (B.172), (B.183), and the proposition that 9{t) = 0, it is clear 
that 

^-0 e = 0, (B.185) 

and hence, 6{t) and 0(t) are constant. From (B.172), (B.175), (B.176), 
and (B.185), the fact that F(t) remains constant, and the proposition that 
^ 0, the following expression can be obtained 

. 2 

Fx = —rripLcj) sin ^ sin 0 (B.186) 

. 2 

Fy — —rripLcj) sin^cos0. (B.187) 

To continue the analysis, the cases of sin 6 = Q and sin 6 are considered. 
Under the additional proposition that sin^ ^ 0, (B.186) and (B.187) can 
be used to prove that sin0, cos0, and 0(t) must be constant since Fx(t) 
and Fy{t) are constant. However, the conclusion that 0(t) is constant con- 
tradicts the proposition that 0(t) ^ 0. Under the additional proposition 
that sin^ — 0, (B.186) and (B.187) can be used to prove that 

Fx = Fy = sin^ = 0. (B.188) 

Given (6.6), (6.19), (6.25), (B.171), and (B.188), it is clear that 

e{t) = 6(t) = 0. (B.189) 

Prom (B.189), the expressions given in (6.16), (6.21), (6.23), and (6.24) 
can be used to prove Lemma (B.21) under the propositions that 6(t) — 0, 
0(t) ^ 0, and sin 6 = 0. □ 

Case 2: 9{t) ^ 0 

If either sin 9 == 0 or cos 9 = 0, then 9{t) would be constant. Hence, 
the proposition that sin 9 = 0 or cos 9 = 0 would lead to a contradiction 
with the proposition that 9{t) 7^ 0. Since 9{t) is a continuous function (i.e., 
since 9{t) G Coo), if is clear that both sin 0 7^ 0 and cos 9 7^ 0 cannot be 
satisfied at the same instant in time. This fact will be used in the subsequent 
analysis. 

To facilitate the stability analysis under the proposition that 9(t) 7^ 0, 
each row of (6.1) can be rewritten as follows 



Pi sin 0 -f P2 cos 0 == 5i 


(B.190) 


Pi cos (f) — P 2 sin (f) — S 2 


(B.191) 


• 2 

9 = —72 sin 9 + 730 sin 9 cos 9 H- 7353 


(B.192) 
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= —29^sm0 COS0 S 4 . (B.193) 

The signals Pi{t), P 2 (t), Si(t), 52(t), 5a (t), S 4 {t) e M introduced in (B.190- 
B.193) are defined as follows 



Pi = sin 6 ^730^ cos^ ^ ~ 72 + 5373 cos 9 (B.194) 



P 2 

1 



rripL 



= 0 sin 0 -h 29 ^ cos 9 
{Fx - {rrip + mr + rric) x) 



52- 

53- - 

54- - 



1 



rUpL 



{Fy - {rup 4- me) y) 



X cos 9sm(f)Fy cos 9 cos 0 



X sin 9 cos 4> — y sin 9 sin'0 



(B.195) 

(B.196) 

(B.197) 

(B.198) 

(B.199) 



where (B.192) has been substituted into (B.194) for 9{t), 7i(^) was de- 
fined in (B.184), and 72,73 were defined in (B.180). After taking the time 
derivative of the expressions given in (B.190) and (B.191), the following 
expressions can be obtained 

^Pi cos (f) Pisincj) — 0P2 sin (f)F P 2 cos (j) = S\ (B.200) 

— 0Fi sin 4>-\- P\ cos (j) — (j)P 2 cos (j) — P 2 sin (j) = S 2 ■ (B.201) 

In (B.200) and (B.201), the terms Fi(t), ^2(^5 S 2 {t) can be 

written as follows 



Pi = 9 ^—72 (1 “ 2 sin^ ^) -f- 730^ cos^ 9 — -f- cos 9^ 

—2730 (^1^) ^ ~ ^ — 273^0^ cos 9 sin^ 9 (B. 202 ) 

—Ssj ^9 sin 9 -{- 5373 ^ 



P 2 — 00 COS 9 -h 0^^^ sin 0 — 2 


^0^0 sin 0 — 00 cos 9 — 9 (j) cos 0^ 


(B.203) 


Si = -^ (f, 
rripL \ 


— {rrip -h rrir + rric) x^^^^ 


(B.204) 


52 = ^ ( 
rripL V 


Fy - {rrip F me) y^^^^ 


(B.205) 
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where the expression for Ss{t) is given as follows 



S3 = ^ (^6x sin 6 sin (p — cos 9 cos (p — x^^^ cos 6 sin 

+ ^ {by sin 6 cos p + cos Osrnp — y^^^ cos 6 cos 



(B.206) 



After substituting (B.192) and (B.193) into (B.202) for 9(t) and p(t), re- 
spectively, and then performing some algebraic manipulation, the following 
expression can be obtained 



Pi = 6 ^—72 (1—4 sin^ 6) + 73^^ cos^ 9 — (^6 + p ^ cos 9^ 

-73 ((2^54 + 353^) sin6» - 53 cos6i) . 



(B.207) 



After multiplying both sides of the expression given in (B.200) by smp, 
multiplying both sides of the expression given in (B.201) by cosp^ and 
then adding the resulting expressions, the following expression is obtained 



Pi — PP2 = Si sin p -\- S2 cos p. (B.208) 



By multiplying both sides of (B.208) by 7i(0), substituting (B.195) and 
(B.207) into the resulting expression for P2{t) and Pi{t), and then dividing 
the resulting expression by 0(t), the following expression can be obtained 

71P3 - 2—^^" cosd=^ (B.209) 

TTT/p Lj [j 

where (B.193) was used. In (B.209), the terms Ps{t)^ 5's(t) G M are defined 
as follows 

P3 = —^2 (1 — 4 sin^ 9) -h 730 cos^ 9 — (^9 -f 0 ^ cos 9 (B.210) 

S5 = 7i ^ 5 i sin 0 + 52 cos 0 + 73 ^ ^SSsb + 2054^ sin 9 — S3 cos 9 ^ ^ 
+540 sin 0. 

(B.211) 

The time derivative of (B.209) is given by the following expression 



7^+3 + 29 P3 sin 9 cos 9 + 2 — {bp^ sin 9 — 200 cos 9^ = 



Ss 9 - S39 



9 ^ 



where the expressions for P3(t) and 5s (t) are given as follows 
P3 = bP4 sin 9 — 273 ^530 cos 9 + 540 cos 9^ 



(B.212) 



(B.213) 
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^5 = 



26 sin 6 cos 6 

■ sin 0 + 52 cos (/) -f 73 ^ {zS ^6 -h 2 '(j)S^ sin 9 — S 3 cos ^ 
+7 i5i sin0 + 7 i5i0cos(/) + 7i52 cos0 — 7j52</>sin</) 

+7i'73 ^^3530 H“ 3 S 36 + 2^84 + 2054^ sin0 
+ (353^ + 2(^54) e COS 6 ^ 



— 7 i 735 s cos 6 -f 7 i73530 sin 6 + 540 sin 9 
+540 sin 6 + 5400 cos 9 



(B.214) 

where (B.192) and (B.193) were used. In (B.213), the term P 4 {t) G R is 
defined as follows 



P 4 = IO 72 cos 9 ~ 730 ^ cos^ 9 + ^0^ + 0^^ , (B.215) 

and in (B.213) and (B.214), the expressions for Si(t), 52(0? 

54 (^) can be determined as 

5i = (Fx - {rup + + rric) (B.216) 

S 2 = (Py - {rUp + me) (B.217) 

TTlplj \ J 

83= ^ ^6x + 29 — 26 sin 0 sin ^ 

+ 9y + 202/(3)) sin 0 cos 0 




54 



+ — ^0^x + 9^ X + 0y + 20y^^^ — cos 0 sin 0 

+ — ^—0^ — 20x^^) +0 i/ + 0 1 / — cos 0 cos 0 
— ^ ^0x cos 0 cos (j) — (j)x sin 0 sin 0 + x^^^ sin 0 cos 0 j 

+— ^0y cos 0 sin 0 + ^0 sin 0 cos 0 + sin 0 sin 0^ 



(B.218) 



(B.219) 
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By substituting (B.213) into (B.212) for Psit) and then multiplying the 
resulting expression by 7i(^), the following expression can be obtained 



6 sin 6 \^IP4 + 271P3 cos(9 + (71 + 4cos^ 0) J (B.220) 

where (B.193) was used. In (B.220), 56(^) G M is defined as 



Se ^ 7i 



S^O — S^6 4/<^cos0 



9^ 



+ 



rripL^ 



-Sa 



(B.221) 



+7i ^273 (^SsO cos 0 -h S4^ cos 6^ ^ 



After dividing (B.220) by 9{t) sin 9 and then substituting (B.209) into the 
resulting expression for 'y^{9)Ps{t), the following expression is obtained 



2 / • 2 . ^ 2/i\ ^6 2^5 cos ^ 

+ (7i+6cos2 0) 



^sin0 



9 



(B.222) 



After multiplying (B.209) by 7i(0), multiplying (B.222) by cos 9, and then 
adding the resulting products, the following expression is obtained 



127 • 2 

7? {P3 + Pi cos 9) + -.(j> cos^ 9 = 87. 

rUpL^ 



(B.223) 



In (B.223), Sj^t) G M is defined as 



\9sin9 9 J 9 



(B.224) 



The expression for (B.223) can be rewritten by using (B.210) and (B.215) 
as follows 



127 • 2 

727i (9 - 6 sin^ 9) + ~^<p cos^ 9 = Sj. 



(B.225) 



To continue the analysis, the time derivative of (B.225) is determined as 
follows 

472^71 ( (9 — 6 sin^ — 37^) sin 9 cos 9 
+ — ^ ("—3^0 sin 0 -h 20 cos cos^ 9 — S7 



(B.226) 
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where S 7 {t) is given by the following expression 



57 = 



56 
sin 6 



25s cos 0 ) sin ^ 



+ cos. 

\.sin. sin 0 g gin./ 



25s cos. . 255 .cos.\ 

: 255 Sin 6 cos 6 



1 S 5 I oc ' p p 

H — + 25s sin 9 cos 9. 

0 9 



In (B.227), the expression for Se(t) can be determined as follows 



cv on • /) n f *^5^ “ , AI(f)COs9 ^ 

Sq = 20 sin 0 cos 0 1 






+7i 



' 55 ^- 55 .("> ^Js^e-S^e 



-26 



( AI9^ sin 9 4/0 cos 9 4/0 cos 9 • 

+7i ... r9 *^4 H — ::: - r 9 *^4 H — "~b *^4 



rripL^ 



rUpL^ 



rripLP' 



+ 47 i 0 ^273 (^S^9 cos 9 + 540 cos 0^ ^ sin 0 cos 0 
+ 27^73 ^ sin 0 + 5s0 cos 0 ^ 

+^ 7 i 73 cos 0 — 5400 sin 0 + 540 cos 0 j 



(B.227) 



(B.228) 
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where S^it) can be determined as 

= [2 (cos^ 6 — sin^ 6) 9^ + 29 sin 6 cos 9 



^ sin (/) 4- ^2 cos + 73 ^ {^S^9 -f 2054 ^ sin 0-53 cos 9 
+ 7 i ^5p^ sin 0 4- 25i 0 cos 0 4- 5i cos (f) — ^ sin ^ 

4"7i cos (j) — 2520 sin 0 4- 52 ^—0 sin 0 — 0^ cos 0 ^ ^ 
4 - 37 i 73 ^530 sin 0 + 253 ^0^ cos 0 4- 0 sin 0^ 

4-53 (^—9^ sin 0 4 - 300 cos 0 4 - 0^^^ sin 0^ ^ 

4 - 27^73 ^540 sin 0 4- 254 ^00 cos 0 4 - 0 sin 0^ ^ 

4 - 27 i 73 ^54 ^—0^0 sin 0 4- 00 cos 0 4- 200 cos 0 4- 0^^^ sin 0^ ^ 
— 7 i 7 s ^ 53 ^^ cos 0 — 2530 sin 0 4- 53 cos 0 — 0 sin 0^ ^ 
4-40 sin 0 cos 0 ^5i sin 0 4- 5i 0 cos 0 4- *?2 cos 0 — 520 sin 0^ 
+4730 sin 0 cos 0 ^ ^3530 4- 3530 4- 2054 + 2054^ sin 0 
+ (3530 + 2054) 0 cos 0 ^ 



+4730 sin 0 cos 0 ^-53 cos 0 + 530 sin 0^ 
+540 sin 0 + 254 ^0 sin 0 + 00 cos 0^ 



+54 ^0^^^ sin 0 + 200 cos 0 — 0^0 sin 0 + 00 cos 0^ . 

(B.229) 

In (B.229), the expressions for S2^\t), and 84(1) can be 

developed as follows 

5p^ “ + nic) (B.230) 
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^ (Ff ) - (mp + me) (B.231) 



^ (^9 cos 6 sin (j) (j) sin 6 cos (j^ (^x + — 26^y^ 

+2 + 6x^^^ — 9(j)y — 9^y — sin 9 sin 0 

+ ^ (0 cos 9 cos (j) — ^ sin 9 sin 4>^ (29 ^x + 9y 29y^^^ j 

(29^x + 29 (^x + 29 ’(j)x^^^ + 9^^^y 
sin 9 cos (j) 

0sin0sin(/> 4- (/)cos0cos0^ 

' (^ X -\- 9 X + ^y -\- 2^y^^^ — x^^^^ 

+T (2^^x + 200X 4- x^^^ 4- 9 ^ x^^^ 4- 



4-302/^^^ 4" 20 y^^^ — cos 0 sin (j) 

— i sin 9 cos 0 4 - cos 0 sin 0 j 

• — 2(j)x^^^ + + ^y — y^^^^ 

4.1 (^-0(3) ;r - 3^a;(3) - 20a;(4) + 2e6y + 2^'^y 
+ 0 ^( 3 ) + ^ 2 ^( 3 ) ( 5 )^ 

cos 9 cos (t> 



(B.232) 
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84 = — ^(px H- —6 y ~ <j) y sin 9 sin cp 

(^9(px -V 9y -\- cos 9 sin p 



+ - 



L 
1 /^2 



(B.233) 



sin 9 cos p 



X p X py 2py^^^ — 

~Z — 29 py^ cos 9 cos p. 

After multiplying (B.226) by 7i(^), the following expression can be ob- 
tained 

472 ^ 7 ? ((9 “ 6sin^0) - 37 i) sin 0 cos 0 
— — cos^ 0sin0 "^^^9p^ sin0cos^ 9 

TTXplj TTlpL ^Jl5.^o4J 



= 71^7 ti^PSa cos^ 9 

rripL^ 

where (B.193) was utilized. After dividing (B.234) by 0(t)sin0cos0 and 
using (B.225), the following expression can be obtained 

. 2 

\2Ip cos 9 / o N o 

,0 (8 cos^ 0 + 37 i) - 12727? = Sg - 45y (B.235) 

TTLplj^ 

where Sg{t) € R is defined as 

■^8 = ( ) f‘^77i cos^^') . (B.236) 

V 6» sin 61 cos 6>y V rUpL^^ J 

By multiplying (B.235) by cos^ 6 and then utilizing (B.225), (B.235) can 
be rewritten as 



(9-6 sin^ 6) (8 cos^ 0 + 37j) — 127 i cos^ 9 = 



S9 

727? 



where Sg{t) S R is defined as 



(B.237) 



Sg = {Sg - 4Sr) cos^ 9 + Sj (8cos^ 9 + 37i) 



(B.238) 



Given the facts that Fx{t) and Fy{t) are constant and i = 0 and j/ = 0, 
it is clear that 

=0 = 0 k>l (B.239) 
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^.(fc) ^ 0 =0 k>2. (B.240) 

Hence, the expressions in (B.196-B.199), (B.204-B.206), (B.211), (B.214), 
(B.216-B.219), (B.221), (B.224), (B.227-B.233), (B.236), and (B.238) can 
be used to prove that 



Si —0, i = 3,4, ...9; 
Si = 0, 2 = 1, 2, ...9. 



(B.241) 



After some algebraic manipulation, (B.241) can be used to rewrite (B.237) 
as follows 



(1 + 2 cos2 e ) (3 (1 + + 5 cos2 

-4 cos2 0(1 + ^ - cos2 = 0. 



(B.242) 



After some further algebraic manipulation, the expression given in (B.242) 
can be rewritten as follows 



cos^ 6 ai cos^ 6 + a2 = 0 



(B.243) 



where ai, a 2 G R are positive constants defined as 



11 / 3 / , / 

~ 2 ^ 7mpL2 “2 - 14 (1 + rUpL^ 



(B.244) 



Since the expression given in (B.243) is clearly invalid, the proposition that 
6{t) ^ 0 must be invalid, and hence, 6{t) = 0. The analysis given in the 
previous cases can now be used to prove Lemma B.21. □ 



B.5.3 Coupling Control Law Analysis 

Lemma B.22 Given the coupling control law of (6.33), the time deriv- 
ative of the following function 

V =^kEE‘^ + ^kpe^e+^kyT-'^r (B.245) 

is given by the following expression 



y = 0 



(B.246) 



only when 



E(q,q) = e(t) =r{t) === 0 



(B.247) 



where E{q,q), e{t), and r(t) are defined in (6.21), (6.2f), and (6.16), re- 
spectively. 
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Proof: To prove Lemma B.22, the set of all points where (B.246) is 
satisfied is defined as F. In the set T, it is clear from (6.38) and (B.246) 
that 

r{t) = 0 r{t) - 0 (B.248) 

and hence, (6.16) and (B.246) can be used to prove that x(t), y{t)^ and 
V{t) are constant, and that 

x{t) = 0 y{t) = 0. (B.249) 

Furthermore, from (6.22) and (B.248), it is clear that 

E{q,q)^{) e(t) = 0 (B.250) 



and hence, E{q^q) and e(t) are constant. 

Similar to the proof of Lemma B.21, the remainder of the analysis can 
be divided into two cases. For the case of ^ — 0 and 0 = 0, Case la in 
the proof of Lemma B.21 can be used to prove Lemma B.22. For the other 
cases, (6.17) can be used to rewrite (6.33) in the following equivalent form^ 



F = 



—kdr — kpC — kyT 
kEE 



(B.251) 



Based on the structure of (B.251), it is clear from (B.248), (B.250), and 
(B.251) that F{t) is constant, and similar arguments as in the proof of 
Lemma B.21 can be used to prove Lemma B.22. □ 



Lemma B.23 Given the gantry kinetic energy coupling control law ( 6 . 41), 
the time derivative of the following function 

V = ksE + (det(M)p-‘) r + hpe^e (B.252) 

is given by the following expression 



V = Q 



(B.253) 



only when 



E{q,q) = e{t) = r{t) = 0 



(B.254) 



where E{q,q), e{t), and r{t) are defined in (6.21), (6.24), <^'^6 (6.16), re- 
spectively. 



^ Since either 6{t) ^ 0 or (p{t) ^ 0, (6.21) can be used to show that E{q,q) > 0, and 
hence, the denominator of (B.251) does not go to zero for the remaining cases. 
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Proof: To prove Lemma B.23, the set of all points where (B.253) is 
satisfied is defined as F. In the set F, it is clear from (6.46) and (B.253) 
that 

r{t) = 0 r{t) = 0 (B.255) 

and hence, (6.16) can be used to prove that x(t), y(t), and V (t) are constant, 
and that 

x{t) = 0 y{t) = 0. (B.256) 

Furthermore, from (6.22) and (B.255), it is clear that 

E{q,q)=0 e(t)=0 (B.257) 



and hence, E(q^ q) and e{t) are constant. 

To complete the remaining analysis, (6.17) can be used to rewrite (6.41) 
in the following equivalent form 



-kdT - kp6 - ky (det(M)p-i) r - a (det(M)P-^)) r 

kE 



(B.258) 

Based on the structure of (B.258), it is clear from (B.255) and (B.257) that 
F{t) is constant, and similar arguments as given in the proof of Lemma 
B.21 can be used to prove Lemma B.23. □ 



B.5.4 Matrix Property 

Lemma B.24 Given the definition for the matrix P{q) given in (6.18), 
the following property holds 

|p-. = _p-. p-., (b.259) 

Proof: To prove Lemma B.24, the time derivative of P{q)P~^{q) is de- 
termined as follows 

|(PP-) = (^p)p- + p(|p-)^ (B.260) 

After noting that the left-side of (B.260) is equal to zero, the expression 
given in (B.259) can be directly obtained by premultiplying (B.260) by 
P-\q). □ 
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